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Abstract 


A 61-state  truth  model  is  developed  for  the  aircraft  to  satellite 
tracking  problem.  The  equations  for  the  Extended  Kalman  I liter  are 
described  and  the  truth  model  is  examined  and  simplified  to  give  a 
12-state  reduced  order  filter  model  of  the  system.  Using  the  method 
of  Covariance  Analysis  which  is  described,  the  performance  of  the  12- 
state  filter  model  against  the  61-state  truth  model  is  evaluated  with 
the  dynamics  profile  of  a high  altitude  aircraft  tracking  a near  earth 
satellite  in  a circular  polar  orbit.  The  measurement  equations  for  the 
truth  model  are  adjusted  over  a range  of  measuring  instrument  precision 
and  the  filter  model  reevaluated.  The  resultant  tracking  accuracies 
are  discussed. 


lilGU  ACCURrXCY  /'TRCRAPf  TO  SATELLITE 

TRi\c.:i;;c  usil'g  j:xit;eded  kaliian 

FILTER 


I.  IL’TRODUCTION 


S Catcricnt  of  the  P rob lem 

Given  two  acceleratinp,  vehicles,  there  are  many  situations  in  which 
it  is  necessary  to  track  one  vehicle  from  the  other  with  a hip,h  def^ree  of 
accuracy.  In  general,  such  a system  cannot  be  modeled  deterministicallv 
and  stochastic  estimation  techniques  must  be  employed. 

This  thesis  addresses  the  problem  of  tracking  a satellite  from  an 
aircraft.  Again,  this  problem  is  varied  and  might  include  tracking  of 
navigation  satellites  from  long  range  transport  aircraft  or  tracking  of 
low  orbit  satellites  from  high  altitude  aircraft  using  laser  devices. 

Tlie  latter  v;ill  be  investigated  in  particular.  Ideally,  the  satellite 
would  transmit  a beacon  signal  to  facilitate  tracking  but  in  practice 
t'ais  cannot  be  guaranteed.  For  the  purposes  of  this  report,  the  satel- 
lite is  assumed  to  be  completely  passive. 

Various  metiiods  are  available  for  formulating  and  solving  the 
track.ing  problem.  One  such  method  which  uses  an  Extended  Kalman  Filter 
to  provide  the  system  state  estimate  is  investigated  in  detail. 


Objectives  of  the  Study 

The  primary  objective  of  the  study  will  be  to  determine  the  feasi- 
bility of  using  a reduced  order  (simplified)  system  model  to  propagate 
the  system  state.  Propagation  will  be  carried  out  using  the  Extended 


Kalm.an  Filter.  To  investigate  feasibility,  the  following  breakdown  of 
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the  probler.  w.^  11  be  followed: 

1.  Develop  the  full  truth,  model  represer. tlr.p  true  sy.stem 
performance . 

2.  Generate  a tracking  profile  representing  a typical 
tracking  'pass ' . 

3.  Using  the  truth  model  from  1.  and  the  tracking  profile 
from  2.  carry  out  a covariance  analysis  with  a reduced 
order  system  model. 

4.  Adjust  the  reduced  order  model  until  satisfactory 
perform.anee  is  obtained. 

Thus,  given  a system  truth  model,  a reduced  order  system  model  will 
be  found  and  tested  using  the  covariance  analysis.  A secondary  objective 
v.’lll  be  to  modify  the  system  truth  model  and  correspondingly  modify  the 
reduced  order  system  model  and  repeat  the  tests  of  the  reduced  order 
model.  The  modifications  v;ill  involve  changes  to  the  measuring  devices 
to  represent  increased  or  degraded  quality.  This  will  be  done  to  deter- 
mine the  quality  of  measuring  instrument  reauired  in  practice  to  achieve 
some  specified  level  of  tracking  performance. 


Assumptions  and  Limitations 

The  system  investigated  here  is  in  fact  non-linsar  so  that  the  basic 
ivalman  Filter  cannot  be  used  to  propagate  state  estimate  and  associated 
covariance.  Various  metliods  are  avialable  for  handling  non-linear  nro- 


blens  among  which  is  the  Extended  Kalman  Filter.  This  formulation , in 
common  with  most  methods  for  handling  non-linear  problems jassumes  that 
the  non-linear  system  can  adequately  be  represented  by  a linear  system 
about  some  trajectory.  That  is,  deviations  from  this  trajectory  can  be 
handled  using  linear  methods.  The  assumptions  inherent  in  the  lineari- 
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zation  process  will  be  desf':Lued  in  detail  under  section  III  which  des- 
cribes tlie  Extended  Kalman  Filter. 

This  study  attempts  to  find  a simplified  reduced  order  system  model 
which  will  adequately  describe  the  true  system  performance.  For  a true 
linear  system,  the  covariance  analysis  is  complete  in  that  it  accurately 
describes  the  filter  performance.  However,  in  applying  linear  techniques 
to  non-linear  systems,  it  is  sometimes  possible  to  obtain  apparently 
good  performance  when  in  reality  the  performance  is  bad.  This  possibility 
is  usually  overcome  by  carrying  out  a *Monte-Carlo ' system  analysis  in 
addition  to  the  covariance  analysis.  This  would  be  desireable  for  the 
problem  but  will  not  be  done  in  this  study. 

Only  one  aircraf t/satellitc  dynamics  profile  is  investigated  in  this 
study.  The  profile  chosen  uses  a low  orbit  satellite  in  a polar  orbit 
tracked  by  an  aircraft  flying  east/west.  This  was  chosen  to  represent  as 
near  as  possible  one  of  the  worst  case  situations  in  which  the  satellite 
passes  almost  directly  overhead.  Clearly,  confidence  in  the  models  would 
improve  if  several  representative  profiles  are  tested.  Also,  the  tracking 
state  equations  are  modeled  in  the  line  of  sight  coordinate  system.  The 
equations  could  have  been  modeled  entirely  in  inertial  coordinates  or 
aircraft  coordinates  possibly  with  different  results. 

It  is  assumed  that  the  tracking  antenna  is  controlled  by  some  closed 
loop  control  system.  The  dynamics  of  such  a system  have  not  been  incor- 
porated into  the  models.  In  fact,  the  system  assumes  that  deviations 
from  nominal  can  instantaneously  be  corrected  at  regular  intervals. 

Finally,  it  will  be  assumed  that  the  coordinate  transformation  matrix 

from  the  tracking  coordinate  frame  to  the  inertial  non-rotating  earth 

centered  coordinate  frame  is  known.  This  assumption  implies  that  the 
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tracker  orientation  relative  to  the  inertial  coordinate  frame  is  known. 

For  the  purposes  of  this  study,  it  will  be  further  assumed  that  the  tracker' 
elevation  axis  always  lies  in  tlie  inertial  X-Y  plane  (See  Fig.  1 Section 
II).  Thus  an  inertial  reference  must  be  available  on  board  the  aircraft. 
The  problem  could  be  considered  by  introducing  a body  (aircraft)  coordi- 
nate system  and  assuming  that  the  tracker  orientation  relative  to  the 
body  is  knoun.  It  would  then  be  necessary  to  assume  also  that  the  body 
orientation  relative  to  the  inertial  coordinate  system  is  knoxvn.  The 
simplest  assumption  which  Implies  no  loss  of  generality  is  the  first. 

That  is,  the  tracker-orientation  relative  to  the  inertial  coordinate 
frame  is  known. 
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II.  SYSTEM  MODELING 

Physical  De sc/lptlon  of  the  Systfem 

Physically,  the  system  consists  of  a satellite  and  an  aircraft 
equipped  with  some  type  of  satellite  tracking  device,  typically  a high 
resolution  radar  or  laser.  The  tracking  device  is  equipped  with  three 
rate  gyros  which  measure  the  tracker  Inertial  angular  velocity  in  three 
components.  Three  accelerometers  measure  the  three  components  of  spe- 
cific force  of  the  tracker  origin.  Some  control  system  is  available  to 
correct  the  estimated  tracker  angular  deviations.  These  estimates  will 
be  found  using  the  Extended  Kalman  Filter  and  the  control  system  will 
have  the  capability  of  instantaneous  corrections.  The  tracking  device 
is  able  to  measure  the  satellite  range,  range  rate  and  small  angular 
deviations  of  the  tracker  from  the  true  line  of  sight.  The  measurements 
are  all  assumed  to  be  imperfect.  The  nature  of  the  corrupting  noises 
will  be  discussed  later. 

The  tracker  depends  for  its  operation  on  the  availability  of  a 
reference  coordinate  system.  This  could  be  the  aircraft  to  body  system 
assuming  the  orientation  is  kno\m  or  the  inertial  earth  centered  coor- 
dinate system.  For  this  problem,  it  is  assumed  that  the  tracker  base 
always  lies  in  a plane  parallel  to  the  inertial  X-Y  plane  (see  Fig.  1, 
next  page).  In  practice  this  would  be  accomplished  with  a closed  loop  con- 
trol system  using  some  Inertial  reference  sensing  device.  Note  that  the 
possibility  that  the  tracker  base  is  translating  or  accelerating  is  not 
excluded. 

Target  State  Equations 

The  target  state  equations  are  expressed  in  the  geocentric  - equa- 
torial non-rotating  coordinate  system  illustrated  Fig.  1.  The  state 
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equations  are; 


Xi  = X4 

X2  = X5 
X3  “ Xg 


\ 

■=  Agj 

+ 

Ad  j 

+ 

Asi 

+ 

Ami 

+ 

Api 

+ 

Wl 

(2-1) 

X5 

= Ag2 

+ 

Ad  2 

+ 

As2 

+ 

Ati2 

+ 

Ap2 

+ 

W2 

Ag  2 

+ 

Ad  3 

+ 

As  3 

+ 

Am3 

4* 

A?3 

+ 

W3 

Xj , X2 , X3  ~ represent  the  target  inertial  position  from  earth  center. 

X^,  X5,  X^  - represent  the  target  inertial  velocity 

^81 » ^82 » ^*83  ~ ‘iK'e  the  gravitational  forces  along  the  Xj , X2 , X3directions 

Adi,  Ad2 , Ad3  - are  the  forces  due  to  aerodynamic  drag. 

Asi,  Ar2,  As3  ~ are  the  solar  perturbations  (gravitational). 

Ami,  Ara2,  Am3  - are  the  lunar  perturbations  (gravitational). 

Api,  Ap2 , Ap3  - are  the  perturbations  due  to  solar  pressure. 

Wi,  W2,  W2  - are  zero  mean  independent  Gaussian  white  noises  added  to 
model  unknown  perturbations  and  to  account  for  approxima- 
tions in  the  above  terms. 

Appendix  A indicates  the  method  of  obtaining  the  earth's  gravita- 
tional attracting  forces  Agi , Ag2,  Ag3  and  the  method  of  finding  the 
second  partials  of  the  gravity  gradient  for  the  earth.  These  will  be 
required  during  the  state  equation  linearization  process. 

Force  Due  to  Drag 

The  drag  perturbational  accelerations  are  modeled  as  follows; 

Ad  is  the  drag  vector  in  inertial  non-rotating  coordinates 

r 1 

jc  is  the  inertial  position  vector 
from  earth  center  to  target 
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Xi 

X2 

X3 
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£ is  die  Inertial  velocity  vector 
of  the  target 


X4 

X5 

Xr. 


Then  ^ = ■ 

where: 


2 ^ 


(2-2) 


0 

e 

h 


a 


atmospheric  density  modeled  as:  p = p^e 


-B  h 


mean  sea  level  atmoshperic  density 
altitude  atmospheric  density  decay  rate 
(Xi2  + X2’  + - R 

0 

mean  earth  radius 

magnitude  of  the  vehicle  velocity  relative  to  the 
rotating  atmosphere.  = 

WE  = earth  rotation  rate,  and  by  the  law  of  Coriolis: 


X4  + 

VJE 

X2 

X5  - 

Xi 

= Zi 

(2-3) 

B - vehicle  ballistic  coefficient 


In  general,  the  ballistic  properties  of  the  vehicle  will  be  unknovm 
However,  the  ballistic  coefficient  B will  not  change  with  time  and  can 
therefore  ne  modeled  stochastically  as  a random  bias.  Such  a model 
implies  100%  correlation  with  time.  B is  therefore  represented  by  the 
system  state  X7  with  the  state  equation 

X?  = 0 (2-A) 

Thus  appropriate  choice  of  an  initial  condition  for  can  be  made  to 
adequately  model  a range  of  vehicle  types. 
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Sun  and  Moon  Gravitational  Pcrti^rhatiions 

The  sun  and  moon  perturbinp,  acceleration  vectors  are  defined 
respectively  as: 

“ T p • 

Asj  Araj 

A§.  ~ ^^2  , ^ = Amp 


For  the  p irposes  of  this  report,  the  sun  and  moon  are  considered 
stationary  in  space  relative  to  the  vehicle  and  earth.  This  assumption 
is  valid  since  the  time  for  a particular  pass  for  a low  orbit  satellite 
will  be  of  the  order  of  minutes  only. 

If  the  sun  and  moon  have  position  vectors  relative  to  the  non- 
rotating inertial  coordinate  system  of: 

Xs  and  Xm 
Ys  Ym  respectively 

Zs  2m 

then  the  perturbational  acceleration  vectors  ^ and  ^ V7ill  be  given  by: 


Xs  - Xi 


Ys  - X. 


Zs  - X. 
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and 


i 

- Xi) 

Xm 

3 

irm 

(Ym 

- Xi) 

- ^ 

r 3 
vm 

rm^ 

(Zm 

- X3) 

_ Zm 

r ^ 
'■vm 

rm^ 

1 

(2-6) 


where 


IS 

Xm  - Xj 

Y 

VTO 

& 

Ym  - X2 

^vm 

s 

Zm  - X3 

^.s 

es 

Xs  - Xj 

Yvs 

= 

Ys  - X2 

^s 

= 

Zs  - X3 

^vs 

B 

■^Xvs^  + YvsZ  + ZvsZ 

^vm 

B 

yj  XvmZ  + YvraZ  + Zvm^ 

rm 

= 

yj  Xffl2  + YmZ  + ZmZ 

rs 

B 

yj  Xs2  + Ys2  + Zs2 

Solar  Pressure  The  force  acting  due  to  aolar  presaure  is  modeled  In  a 
Simple  way  using  the  relationship; 
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K is  a proportionality  constant  of  4.5  x 10“  m/sec  (Ref.  1)  and 
S is  the  solar  pressure  coefficient.  This  latter  coefficient  depends 
directly  on  the  vehicle  surface  area  presented  towards  the  sun  and  in- 
versely on  the  mass  of  the  vehicle.  Again,  no  information  is  available 
about  the  vehicle  and  S is  again  modeled  as  a random  bias  X0.  The  sta*'e 
equation  for  Xg  is  therefore: 

Xg  = 0 (2-8) 


and  appropriate  choice  of  the  Initial  condition  tor  X will  adequately 
model  the  range  of  vehicles  of  primary  interest. 

Tracker  State  Equations 

Fig.  2 illustrates  the  geometry  of  the  typical  tracker.  The  table 
is  aligned  with  a reference  plane  which  in  this  case  will  be  the  inertial 
plane.  The  tracker  is  thus  restricted  to  rotate  about  the  azimuth  ver- 
tical axis  and  the  elevation  axis.  The  vertical  axis  of  rotation  will 
always  stay  aligned  with  the  Inertial  vertical  axis  while  the  elevation 
axis  will  be  restricted  to  lie  in  the  inertial  horizontal  plane  only. 

Note  that  the  tracker  is  configured  such  that  the  tracker  X’j'  axis  points 
along  the  antenna  center  line,  while  the  tracker  y-p  axis  points  out 
through  the  tracker  elevation  axis  and  therefore  always  lies  in  the 
plane  of  the  table  as  shown.  The  tracker  axis  forms  the  third  vec- 
tor in  an  orthogonal  system. 
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Fig.  2 Tracking  Antenna  Configuration 


lig.  3 shows  the  relation  betx^een  the  inertial  X,  Y,  Z frame, 


which  is  an  earth  centered  non-rotating  frame,  and  the  tracker 
frame. 


Fig.  3 Inertial  and  Tracker  Coordinate  Frames 

From  the  above  figure  it  can  be  seen  that  the  tracker  frame  orientation 
is  obtained  via  two  Euler  angle  rotations  6 and  0 in  the  azimuth  and 
elevation  directions  respectively  from  the  inertial  frame.  Denoting 
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tlic  inertial  frame  as  t’.ie  I-frame  and  the  tracking  frame 
v.’e  define  the  coordinate  transformation  matrix  as  the 
matrix  from  I-coordinates  into  T-coordinates , then: 


as  the  T-frame 
tr  ansf ormatlon 


C 


T 

I 


cos  (fi  0 

0 1 

sin  (|)  0 


-sin 

0 

cos 


— 

■ 

cos 

0 

sin 

0 

0 

-sin 

0 

cos 

0 

0 

0 

0 

1 

cos  e cos  (J'  sin  6 cos  <j>  -sin  if 

-sin  e cos  e 0 

cos  0 sin  4>  sin  6 sin  li  cos  (}) 


(2-9) 


Now,  the  Euler  rotation  angles  0 and  can  he  determined  by  con- 
sidering the  geometry  of  the  tracking  problem.  Let  the  relative  position 
vector  of  the  target  from  the  aircraft  be  expressed  in  Inertial  X,  Y,  Z 
coordinates  as  : 

Defining  as  the  relative  position  vector  expressed 
in  inertial  I-coordlnates  and  as  the  relative  posi- 
tion vector  expressed  in  tracker  T-coordinates  then: 


R 


T 


and  r"^  = Cj  (2-10) 


P-j,  CCS  0 cos  4>  + R^  sin  0 cos  (+■  - R^  sin  (fi  ' 
~^X  ® cos  G 

Rjj  cos  6 sin  (t  + R^  sin  0 sin  (J>  + R^,  cos  <p 


R-* 


R 


R 


R. 
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If  we  define  the  ranpe  from  aircraft  to  target  as  the  scalar  variable  R, 

T 

t:\cn  R “ the  X-component  of  the  vector  R and  the  Y and  Z components 
are  both  zero  for  perfect  tracking. 

Thus 

R = R^  cos  0 cos  (p  + Ry  sin  0 cos  (}i  + sin  ({) 


And 


-Ry  sin  0 + Rv  cos  0=0 


tan  0 


is  determined  as  follows: 


0 = arc  tan  (Ry/R^^)  if  > 0,  Ry  arbitrary 


(2-12) 


= arc  tan  (Ry/R^)  + u if  Rj>  < 0,  Ry  arbitrary 

Similarly, 

cos  0 sin  ^ sin  0 sin  (j)  + R^  cos  (p 


Ry 


+ Ry  + 


R-, 


0 


tan  0 tan  ij)  sin  0 


but 


R-« 


sin  0 = 1, 

(Rx^  + Ry2)^ 


So 


(Rx^  ^ ^ ’ (Rx^ 


Ry  • tan  (}i 


-R_ 


tan  <fi  «> 


2^^ 


(Rx‘  + Ry  ) 


(2-13) 
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Thus  far,  the  relationship  between  the  tracker  and  inertial 
coordinate  frames  has  been  established  and  it  has  been  sho,^  that 
the  coordinate  t ran format ion  matrix  is  dependent  entirely  on  the 

relative  position  vector  from  aircraft  to  target  expressed  in  inertial 
coordinates. 

In  practice,  perfect  tracking,  in  which  the  xx  vector  aligns  per- 
fectly with  the  target  line  of  sight,  will  not  be  possible.  The  tracker 
frame  will  in  fact  be  slightly  misaligned  from  the  true  line  of  sight 
coordinate  system  denoted  This  system  has  the  x^^  axis  pointing 

directly  towards  the  target  and  is  related  to  the  target  coordinate 
system  as  shown  by  Fig.  4. 


Fig.  4 Target  and  Line  of  Sight  Coordinate  Frames 
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Or>?e  again,  the  two  fr,ames  can  be  coincided  througli  tw’o  small  Euler 

rotations  6e  and  6n.  6n  rotates  the  LS  - frame  about  the  tracker 

axis  and  6c  rotates  the  LS  - frame  about  the  line  of  sight  axis. 

LS 

The  coordinate  transformation  matrix  Ct  transforms  a vector  from  T - 
coordinates  into  LS  - coordinates  and: 


cos  6n  cos  6e 
-sin  6n 
cos  6n  sin  6e 


sin  6n  cos  6e 
cos  6n 

sin  6n  sin  6e 


-sin  6c 
0 

cos  6c 


For  near-perfect  tracking  in  which  the  angles  6c  and  6n  are  small, 
it  is  possible  to  make  the  small  angle  assumptions: 


6 

V 


cos  6n  - cos  6c  = 1 


then: 


sin  6n  = 6n,  sin  6e  = 6e 


6c6ri  = 0 


1 6n  -6c 

- 6n  1 0 

6e  0 1 


(2-14) 


In  practice,  the  tracking  device  will  be  capable  of  providing 
measurement  information  concerning  the  two  small  angles  6c  and  6n; 
hence  it  is  necessary  to  establish  the  state  equations  expressing  the 
time  rate  of  change  of  the  two  angles. 

The  motion  between  the  T-rotating  frame  and  the  LS-rotating  frame 
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is  ctiarncterized  by  the  followinjr  dif ftiruntial  equation:  (Pef.  7) 


c ^ = c"^  V’ 

^■LS  \s  ' lS 


V c"^ 
T ^LS 


(2-15) 


where  '.7,  and  \lj  are  the  ske\;  syr.inetric  ir.atrices  defined  as 


W, 


LS 


0 

•^LS- 

^LSy 

> 

T ▼ _ 

’ 0 

“(jOrr 

‘‘Ty 

“LS^ 

0 

-'"LSx 

W™, 

0 

COrp 

:‘\Sy 

"lSx 

0 

■^x 

0 

and  the  elements  of  th.ese  matrices  represent  the  angular  velocities 
about  the  particular  axes  subscripted, 
how,  the  two  vectors: 


LS 

‘^LS 


■‘^'LS^' 

and 

1 

_T 

to  nr 

“^LSy 

“^y 

1 

CO 

3 

' 1 

tsi 

H 

3 

! 

are  inertial  angular  velocity  vectors  expressed  in  line  of  sight  LS 
coordinates  and  tracker  T - coordinates  respectively. 

From  (2-15) , 


Ct^  = U 


T ''LS  "LS 


‘T^LS 


or 


a + A)  (-A)  = v:. 


LS 


Ct  W.J. 
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Nef;lectinj;  second  order  quantities  j.ivcs: 

-A  . 1,^5  - (2-18) 


The  above  equation  can  be  written  out  as: 
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which  provides  the  two  required  state  conations  for  6c  and  6n  as: 


on  ~ **’LS  ””  ^’T  ~ ^ T 


‘^Sy  “ ‘"'Ty  ‘^r 

X 

In  order  to  detertrdne  the  time  evolution  of  the  line  of  sight 
angular  velocity  vector  > consider  the  position  vector  of  the  target 

relative  to  the  aircraft  which  was  defined  as  ^ Olote  t!;at  the  nagnitude 
of  R is  the  scalar  range  variable  R also  previously  defined)  . 

Differentiating  ^ tv;ice  with  respect  to  inertial  space  and  applying 
tiie  theorem  of  Coriolis  each  time  gives  the  eouation: 


X dR 


+ i!l,s  >:  (“ls  ?-> 


(2-20) 


w'nere  the  vertical  line  denotes  the  frame  relative  to  which  the  deriva- 
tives are  taken,  so  that  the  left  hand  side  of  equation  (20)  i.e. 


represents  the  total  rate  of  change  of  -= 

dt^  I clt 


which  is  also 


the  total  rate  of  change  of  the  relative  position  vector  R. 

Equation  (2-20)  is  entirely  general  and  not  referenced  to  any 
particular  coordinate  system.  Choosing  the  line  of  sight  coordinate 


system  and  expression  ^ Ji  in  the  line  of  sight  system  ^s  r 

X 


19 


!^*«OTrT  T* 


7 VT^i^rv?*TO7^.  ^C'n'7?'*? 


GA/r,t:/74-3 


= Relative  acceleration  measured  alonp,  line  of 


sight  Y - axis 


= Relative  acceleration  measured  along  line  of 


sight  Z - axis 


thus,  if  = target  acceleration  along  line  of  sight 

X 


X - axis 


and  A = tracl;er  acceleration  along  line  of  sight  X - axis 

TR^ 


then:  A 


rel. 


= A 


TAR. 


X ■ X 


etc. 


Equations  (2-22)  to  (2-25)  thus  represent  the  exact  relationships 

for  the  aircraft/satellite  tracking  problem.  It  should  be  noted  that 

there  is  no  state  equation  relating  the  motion  of  the  tracker  about 

the  X - axis  in  the  line  of  sight  coordinate  svstem,  i.e.  tu.  o . The 

Lbx 

reason  is  simple,  for  the  purposes  of  tracking,  angular  velocity  about 
the  line  of  sight  has  nr  significance.  This  does  not  hov:ever  preclude 
the  requirement  to  raes.ura  the  tracker  angular  velocity  in  that  direction 


but  since  there  is  no  state  equation  for  , it  must  be  elininatpd 


from  equations  (2-24)  and  (2-25). 

In  practice,  angular  velocities  will  be  measured  in  the  tracking 
coordinate  frame  since  there  is  no  physical  way  in  which  they  could 
be  measured  in  the  line  of  sight  frame.  The  substitution  from  equation 
(2-18)  is  made,  i.e. 


LS. 


- 0) 


X 


T + 6n  “rp 


- 6e 


(2-26) 
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and  equations  (2-2^)  and  (2-25)  now  become: 


LSy 


- A , 
R 


2 V 


r“  ‘^LS^  ■'‘'Tx  ‘'T  ^ (2-27) 


‘^S  = I ^ 


rely 


2 Vr 
R ■ "'LS, 


•^LSy  ‘^T  ^ (2-28) 


The  definitions  for  and  Aj-g^^^  ap,ain  are  made  in  the 

line  of  sight  coordinate  system.  Acceleration  measurements  for  the 
tracker  are  only  available  in  the  traclcer  coordinate  system  in  which 
tlie  tracker  acceleration  vector  is  defined  as: 


and  accelerations  of  the  target  (satellite)  are  only  available  in  the 
inertial  coordinate  system  as: 


Ag  can  be  transformed  from  the  inertial  coordinate  frame  into  the  tracker 
coordinate  frame  by  the  transformation 
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Thus,  the  vector  of  relative  accelerations  in  the  tracker  coordinate 
frame  defined  as: 


f 


A 


R 


(2-iO) 


must  be  used  to  obtain  the  vector  i.e. 


A 


rel 


where  = 

T 


1 6n  -6g 

-5n  1 0 

6e  0 1 


(2-31) 


■ \el^  ' 

• 1 

6ri  -6c 

1 

X 

< 

^rely 

= 

-6n 

1 0 

A^ 

ry 

- Arelz 

. 6e 

0 1 . 

.A 

(2-32) 


Substitution  from  equations  (2-31)  and  2-32)  into  (2-27)  and  (2-28) 
gives  the  final  form  of  the  two  line  of  sight  angular  velocity  equations 
as : 


C 
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-2  V, 


^LSy 


0) 


LSv. 


*Ay  IxXj  fi  OJrp 


-6c 

„ A 4-  u> 

R rx  LS^ 


■^z  b 


- 6c  c) 


TZ 


(2-33) 


-2  V. 


LS, 


0) 


LSc 


+ i A 


R '"ry 


"LSy 


-in  A^ 
R * 


(jC 


LS^ 


j^6n 


o)T^ 


6c 


»tJ 


(2-34) 


Note  thc't  in  ec;uations  (2-33)  and  (2-3A) , the  two  bracloted  terms 
represent  modifications  to  the  state  equations  for  perfect  tracking. 

These  modifications  account  for  the  small  angular  deviations  6e  and  on 
from  the  perfect  tracking  situation. 

Finally,  equation  (2-32)  is  substituted  into  equation  (2-23)  to  give: 


Vr  = A^v  + P'<Vsy  ^ 


LSz 


rz 


which  is  the  final  state  equation  for  Vj.. 

Measurement  Equations  (Ref,  2,  3,  and  5) 

Measurements  to  the  tracking  system  as  already  stated  will  consist 
of  inertial  angular  velocity  of  the  tracker  measured  in  the  tracker 
coordinate  frame  by  three  rate  gyros,  measurements  of  tracker  inertial 
acceleration  again  in  the  tracker  coordinate  frame,  measurements  of  range 
and  range  rate  and  measurements  of  the  two  small  angular  deviations  6e 
and  6n.  None  of  the  measurements  arc  assumed  perfect.  Now  the  system 
propagates  the  true  line  of  sight  angular  velocities  and 


whereas  measurements  are  available  only  of  the  tracker  angular  velocities 
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ui'r,.,  wj  , . Moas'jremonts  of  u>,p  thus  constitute  true  measurements 

'■A  -^Y  A 

of  parameter  while  measurements  of  and  are  interpreted 
as  pseudo-measurements  of  o'lSy  ‘^LSjr  respectively.  If  the  tracking 
is  good,  these  measurements  approach  tr'>.e  measurements.  Measurements 
of  angular  velocities  in  the  line  of  sight  system  would  be  most 
iesireable  but  in  a practical  s”stem  sucli  measurements  would  not  be 
available.  It  should  also  be  noted  that  the  tracker  accelerations  are 
not  states  of  the  system.  Thus  measurements  of  tracker  accelerations 
are  measurements  of  system  parameters. 

^e asurement  of  Tra cRer  Anc ul ar  Velocities 

These  are  provided  by  three  rate  gyros  mounted  approximately  in  the 
tracking  coordinate  frame.  The  approximation  arises  because  in  practice, 
the  gyros  will  always  be  slightly  misaligned  from  the  true  frame  align- 
ment. To  simplify  the  discussion,  only  the  measurement  of  (D-p^  will  be 
described.  Measurements  of  the  other  tv’o  angular  velocity  components 
are  modeled  identically  in  form.  The  measurement  of  angular  velocity 
in  the  direction  is  thus  modeled  as: 


tiH,  = Urp  + Bgsfy  u)_  + E Bgmv  + C„ 

^ i ,,  1 ^i  ^ 6X 


+ AC- 


1 . V 


(2-36) 
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The  terras  in 


Uu 

.X 


O'Tx 

Bgsf^ 


Bgmx^ 


equation  (2-36)  are  as  follows; 

measured  angular  velocity  along  Xj  - axis  (see  Fig.  2) 
true  angular  velocity  along  x.j.  axis 
constant  (bias)  gyro  scale  factor 

coefficients  (along  X,  Y,  and  Z directions  of  tracker 
coordinate  frame)  of  the  g - sensitive  mass  unbalance 
to  which  tii^  gyro  is  subject 


= Accelerations  A-j^  , A.J.  ) of  the  tracker  origin 

X y z 


CgY  “ gyro  drift  term  along  the  X.p  axis. 


•iCgraa  = the  error  angle  transformation  resulting  from  the 
misalignments  of  the  three  gyros 


0 Bgmaj2  Bgma 
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ACgraa  A 


Bgraa2 1 0 


Bgma 
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Note  that  for  the  purposes  of  this  study,  the  terms  in  the  above 

matrix  are  considered  constant  and  result  from  the  small  angle  approx- 
imation. 

Vj  is  an  additive  white  noise  used  to  compensate  for  any  unmodeled 
effects  such  as  aniso-elastlc  drift. 

The  above  terras  can  be  modeled  stochastically  as  follows:  The  gyro 

drift  term  Cg^  can  be  modeled  as  a first  order  exponentially  time  co- 
related random  variable.  Drift  is  not  a white  random  noise  process 
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but  does  shc'.J  a degree  of  correlation  in  time.  I.aboratory  data  indi- 
cates that  the  exponential  model  adequately  describes  this  correlation 


The  state  equation  for  C_  will  thuf  be: 

Sx 


-64  CgY  + \j2  64  04  U4 


(2-37 


where  if  represents  the  system  correlation  time, 

R ^ i- 

is  the  ms  value  of  the  process,  and  U[^  is  a unity  variance  white 
driving  noise.  Fig.  5 below  shows  the  equivalent  linear  system: 


1C 


Fig.  5 


Linear  System  Representation  for 
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in  Fig.  5 is  c •:'n.lte  driving  noise  of  variance  q = 
The  autocorrelation  function  for  is  given  by: 


E C„  (t)  C„  (t  + t) 


\X 


Ol,‘ 


Note  that  by  appropriate  choice  of  initial  condition  for  C„  , an 
initial  knovm  bias  in  drift  can  be  accounted  for. 

The  remaining  coefficients  represent  unknowns  in  tho  system.  One 
fact  is  certain  however;  none  of  these  coefficients  will  vary  w^ith  time. 
For  example,  the  gyro  misalignment  coefficients  have  values  which  des- 
cribe how  the  gyros  are  displaced  during  assembly  from  their  true 
orientations.  V/hile  these  displacements  may  not  be  known,  it  is  certain 
that  in  the  time  scale  of  a typical  satellite  pass,  they  will  not  change. 
The  model  chosen  to  represent  the  coefficients  therefore  will  have  the 
general  form: 


0 


This  is  a linear  equation  and  the  covariance  equation  which  corre- 
sponingly  describes  the  way  in  which  the  covariance  of  a coefficient 
will  change  in  time  is  given  by  the  general  form: 


P = F P + P (where  f"^  denotes  the  trans- 

pose of  F,  and  F is  the 
system  matrix) 


Thus,  P = 0, 


and  this  implies  that  tht?  variance  of  a coefficient  likewise  will  not 
change  with  time.  Choice  of  initial  conditions  on  X and  P completely 
describe  a coefficient.  The  initial  condition  on  X represents  the  mean 
value  of  the  coefficient  and  the  initial  condition  on  P represents  the 
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variance  of  the  distribution  of  X about  its  mean.  Often,  hovever,  the 
only  information  available  about  the  coefficient  will  be  the  variance, 

in  which  case,  the  most  reasonable  choice  for  an  initial  condition  on 
X is  zero. 


Measurements  of  Tracker  Accelerations 


The  tracker  accelerations  are  parameters  of  the  system  rather  than 
states.  The  measurements  are  modeled  as  follows.  Note  that  only  the 
measurement  equation  for  the  acceleration  in  the  direction  is  given. 
The  remaining  equations  are  identical  in  form. 


\ ^ "^"^X  ^ax  + 2nonXj  ^Tx^  + ^ ^ 


'2  ^X 


(2-38) 


The  terms  in  equation  (2-33)  are  defined  as  follows: 


A^ 


'■M 


measured  acceleration  along  direction  in  tracker 
coordinate  frame 


^ - true  acceleration 

X 


Sas^  - accelerometer  scale  factor 


'Hx  accelerometer  drift  and  bias 


Bnon^^  = accelerometer  (g2)  non-linear  coefficient 


Bnon 


X^  =■  accelerometer  (g^)  non-linear  coefficient 
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A 

ACia&  ° 0 Bamaj2  Bamajg 

Bama2j  0 Bama2 3 

. Bama^j  Bama32  0 ^ is  the  error  angle 

transformation  matrix  which  supplies  the  accelerometer  misalignment 
coefficients. 

Note  that  the  small  angle  approximation  has  been  made  in  using 
this  matrix. 

Vi^  = white  noise  to  account  for  unmodeled  effec.'".'?. 

Once  again,  as  in  the  case  of  the  rate  gyros,  the  coefficients  in 
the  measurement  equations  are  modeled  as  states  of  the  system.  The 
accelerometer  drift  and  bias  is  modeled  as  a first  order  exponentially 
correlated  random  variable.  This  choice  of  model  is  justified  since 
the  magnitude  of  the  drift  will  in  fact  vary  with  time.  The  degree  of 
correlation  in  time  is  expressed  by  the  constant  used  in  the  state 
equation.  Note  that  equation  (2-37)  describing  the  gyro  drift  shows 
the  form  of  these  equations.  In  addition,  the  remaining  coefficients 
are  once  again  modeled  as  random  biases. 

Measurement  of  Angular  Misalignments  Be  and  6n 

Tlie  tracking  device  will  be  capable  of  providing  measurements  in  the 
tracking  coordinate  frame  of  the  two  angular  misalignment  angles  6c  and 


6n.  See  Fig.  4 for  a description  of  the  geometry.  6n  is  measured  about 
the  - axis  and  6e  is  measured  about  the  y^g  - axis.  In  practice, 

the  LS  - coordinate  frame  and  the  T - coordinate  frame  will  be  closely 
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aligned  and  5c  will  in  fact  be  assumed  to  be  measured  about  the  - 
axis. 

Now  there  are  clearly  many  different  measuring  devices.  If  a 
radar  scanner  were  used,  the  measurement  device  miglit  be  different  to 
that  used  uitli  a laser  tracker.  However,  a semev/hat  representative 
model  is  chosen  \;hlch  could  easily  be  adjusted  to  suit  the  particular 
device.  The  measurement  model  for  the  two  error  angles  has  the  follov7ing 
form: 


®AT  '^7 


^SF. 


(2-39) 


= K2(6n  + Sn)  + Cgp  • 6n  + + Va 


where  the  various  coefficient  are  as  follows: 


Kj , K2  - deterministic  scale  factors 


S^,  - angle  track  scintillation  noises 


CsF  I Cgp  - scale  factor  errors 


®AT  ’ ^AT  " sngle  track  biases 


V7,  Va  - white  gaussian  additive  noises  to  account  for 
unmodeled  effects 


Ki  and  K2  are  assumed  to  be  known.  S^.  and  are  modeled  as  first  order 
exponentially  time  correlated  random  variables.  This  model  is  used 
since  the  scintillation  noise  is  dependent  on  various  factors  such  as 
atmospheric  propagation,  amplifier  characteristics,  etc.  This  type  of 
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factor  does  not  change  instantaneously  with  time  but  fluctuates.  Again 
the  state  equation  used  will  have  the  form: 

• — 

“ -Bl  2 Bl  oi  Ui  (2-AO) 

1 9 

where  Bj  " correlation  time  of  the  process.  o£  is 

the  steady  state  covariance  of  the  noise  and  Ui  is  a white  driving 
noise  with  unity  covariance. 

The  scale  factor  errors  C„_  and  Cet?  are  modeled  also  as  first 

SF^  SFn 

order  exponentially  correlated  random  variables  with  state  equations  of 

the  form  shovm  in  (2-40)  above.  This  is  another  v;ay  of  stating  that 

the  constants  and  K2  are  not  really  constants  but  random  variables 

which  are  expcaentially  time  correlated  and  have  a non-zero  mean. 

Again,  the  justification  for  using  this  model  is  that  the  scale  factors 

are  really  determined  within  some  type  of  electronic  equipment  which 

exhibits  time  correlated  behaviour. 

The  remaining  coefficients  and  B.„  can  be  adequately  modeled 

° Aij.  Ai 

e n 

as  random  biases,  i.e.  The  actual  values  are  unknown,  the  covariance 
is  known  and  the  variable  has  100%  time  correlation. 

Measurement  of  Range 

The  measurement  of  range  is  very  similar  to  those  of  the  angular 
misalignment  angles  except  that  the  scale  factor  error  is  omitted. 

The  measurement  equation  is  thus; 

^ ■ V'  * S^)  + + V,  (2-41) 
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whers: 


R 


measured  range 
true  range 

range  scintillation  noise 
range  bias 

v;hite  gausslan  additive  noise  to  account  for  unmodeled 
effects 


The  actual  electronic  methods  by  which  range  is  measured  vary  from 
those  by  which  the  angular  misalignments  are  measured.  In  general,  the 
latter  depend  to  some  extent  on  analog  equipment  (linear  amplifiers, 
etc.)  while  the  range  measurement  can  usually  be  accomplished  digitally 
with  very  little  analog  equipment.  The  digital  equipment  can  usually 
be  accurately  calibrated  so  that  only  the  scintil.1  ation  noise  and  bias 
need  be  stochastically  estimated.  The  bias  will  be  small  in  magnitude 
compared  to  the  scintillation  noise  and  will  result  from  the  equipment. 
The  scintillation  noise  v/ill  however  be  tlie  additive  effect  of  the 
digitization  of  the  range  and  the  atmospheric  fluctuations.  These  can 
be  combined  and  modeled  as  the  familiar  first  order  exponentially  time 
correlated  random  variable.  The  bias  is  considered  to  be  fixed  but 
unknovm  and  can  therefore  be  modeled  as  a random  bias. 


Measurement  of  Range  Rate 

The  experiments  performed  with  this  model  have  shovm  that  the 

measurement  of  range  rate  is  usually  redundant  since  range  measurements 

made  at  a high  frequency  will  yield  the  same  information.  The  possibility 
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of  a range  rate  measurement  is  therefore  not  Investigated. 


Summary  of  System  Truth  * lodcl  State  and  Measurement  Equations 

The  above  state  and  measurement  equations  for  tlie  system  truth  model 
are  summarized  as  follows: 


(9) 


Satellite  Inertial  Position 


State  Equations 

CD  Xi  = X4 

(2)  X2  “ X5 

(3)  X3  = Xs 

(4)  X4  = Agi  + Adj  + Asi  + Ami  + Api  + Wi 

. Satellite 

(5)  X5  = Ag2  + Ad2  + As2  + Am2  + Ap2  + W2  Inertial 

Velocity 

(6)  Xg  = Ag3  + Ad3  + As3  + Am3  + Ap3  + W3 

(7)  X7  = 0 

(8)  Xg  = 0 


Satellite  Ballistic  Coefficient 


LS^ 


i A 
R 


Satellite  Solr’*  Pressure  Coefficient 
2 Vr 


R 


_£  (1)  + m 0) 

LSy  LS^,  Tx 


\ <5e  Ar  ^ u 

6n  “p  - 6e  w 

LS2 

L Y Tg  J 

R 

/ 

Tracker 

Angular 

Velocity 
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(26)  B c 0 


(34)  =.  0 


(35)  B,„  = 0 


(36)  B^g^  = 0 


(37)  B, 


(38)  B„„,  = 0 

’ gmai2 


(39)  lignia  1 3 “ ^ 


(40)  B„„^  = 0 

gma2i 


(41)  B„^^  = 0 

gma2  3 


(42)  = 0 

gmasi 


(«)  Bgmajj  - 0 


(45)  B, 


(^6)  - 0 


(47)  = 0 

cUHB^  3 


(^8)  = 0 

araa3i 


(49)  B = 0 

ama32 


Coefficients  of  Gyro  Mass  Unbalance 
(nine  equations) 


Accelerometer  Scale  Factors 


Gyro  Misalignment  Coefficients 


Accelerometer  Misalignment  Coefficients 
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(50) 

B 

nonx^ 

= 0 

(51) 

* 

®nonx^ 

“ 0 , 

(52) 

» 

D 

nony^ 

= 0 

(53) 

• 

^non„ 

Y2 

= o) 

Accelerometer  (g2  and  g^)  non-linear 
coefficients 

(54) 

(55) 

• 

^nOH7 

■ 

B 

nor.7 

o o 

M U 

J 

> 

(56) 

K - “ 

Range  Bias 

(57) 

V ° 

0 

1 

(58) 

®AT 

0 

) 

Angle  Track  Bias 

(59) 

® f “ 

gsfx 

0 

' 

(60) 

B f = 
gsfy 

0 

^ Cyro  Scale  Factors 

(61) 

B , = 

gsfz 

0 

> 

The  truth  model  therefore  has  a total  of  61  state  equations.  Of 
these,  the  first  14  represent  the  true  system  dynamics  while  the 

remaining  47  equations  are  introduced  to  model  the  measurements  to  the 
System. 
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Measurerncnt:  Equations 

3 

(1)  ■'■  <=gx 


^^gma  ^ 


+ Vj  measurement  of  Wf 


- X 


(2)  = a.T^  + Bggf^  ‘‘^y  + ^ ^ ^ 


^^gma 


+ ^2  measurement  of  tOr, 


C)  + Bg3£j  “Tx  + £ Vzi  *1 

i * 1 1 f- 


+ I ACgxna  “x 


L 


+ V3  measurement  of  loy 


where 


AC 


gma 


0 B B^, 

gma^2 


B. 


gma2i 


0 B 


gma 


23 


B 0 

gmaai  gma32 


and 


Ay 


acceleration  of  tracker  origin 
in  tracker  coordinates 


^3  ® 
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(4) 


+ B, 


. Ayp  + C„  + B 
"X  ®X  >■ 


+ B 


‘Xo 


+ AC  , A + V 

ma  T , 

L — J X *♦ 


Measurement  of 


(5)  - \ + A + Ca^,  + 


^ A ^ + R 

nonyj  Ty  "Ty 


|^4Cjja  Kj.  J 


Measurement  of  A^j. 


(6)  Am  — + B Am  + C’  + B Am  ^ + B Am ^ 

^Zm  % asz  h H no"Zi  non^  ^z 


+ V 


Measurement  of 


V7here  = '"  0 B B 

nia  amajz  amaj^ 


®ania2  j ® ^ama^  ^ 


B B 0 


(7)  6ej^  = k^(6c  + S^)  + 6e  + B^^  + V^ 


Measurement  of  6e 


(8)  6ri^  = K^(6n  + S^)  + Cgp  6n  + B^^  + Vj 
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( 


(9)  Rj^  “ Kr(R  "t  Sp)  + + Vg  Measurement  of  R 

Appendix  D lists  a typical  data  set  for  use  with  the  above  measure- 
ment equations. 

Use  of  Measurements 

The  above  measurement  equations  are  the  total  measurements  available 
to  the  system.  However,  only  equations  (2),  (3),  (7),  (S)  , and  (9) 
correspond  to  measurements  of  the  states  of  the  system.  The  remalninR 
equations  are  measurements  of  system  parameters.  Thus  the  true  system 
measurement  vector  has  only  the  above  5 elements.  There  are  two  ways 
in  which  the  other  measurements  can  be  incorporated  into  the  svstem. 

One  method  would  be  to  consider  the  true  system  measurement  vector  to 
contain  all  9 elements  and  the  other  method  v;ould  be  to  rewrite  the 
state  equations  and  substitute  the  measured  value  of  a param.eter  for 
the  true  value.  The  latter  method  limits  the  number  of  measurement 
equations  to  5 which  is  desireable.  In  addition,  since  tVie  true  oara- 
meter  values  w’ill  not  be  known  and  the  best  information  about  tiiese 
parameters  is  contained  in  tlie  measurements,  the  latter  method  would  be 
implemented  in  practice.  For  tlm's  problem  therefore,  the  measured  nara- 
meter  values  replace  the  true  values  in  the  state  evnuatlons  and  t'"'o 
number  of  measurement  equations  w'ill  actuallv  be  5. 

Lincariza tlo n of  Sea te  and  ?!e ar.urcmcnt  Equations 

Appendix  B show^s  how  t!ie  state  and  measurement  equations  for  the 
truth  model  are  linearized  for  application  to  a covariance  analvsis 
of  an  Extended  Kalman  Filter. 
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III.  EXTEriDED  K.y;.>W'I  FILTER 
Basic  Kalman  Filter  (Ref.  12) 

To  understand  the  Extended  Kalman  Filter  formulation  used  in  the 
study,  it  is  first  necessary  to  examine  the  equations  for  the  Easic 
Kalman  Filter.  For  this  study,  the  state  equations  of  motion  are 
continuous  in  time.  Computationally,  the  equations  are  discretized  but 
choice  of  an  integration  interval  short  compared  to  the  system  time 
behaviour  ensures  that  the  system  is  effectively  continuous.  Measure- 
ments are  incorporated  at  discrete  points  in  time.  Thus  the  continuous 
form  of  the  Kalman  Filter  with  discrete  measurement  updates  is  appropriate. 
The  follovjing  definitions  will  be  required: 


x(t^) 

x(t) 


x(t 


jc(ti+) 


nti,t.  _ 


p(4) 


system  state  at  time  t^  - (n  vector) 

filter  estimate  of  the  system  state  at  time 
t - (n  vector) 

filter  estimate  of  the  system  state  at  time  t^ 
before  a measurement  is  incorporated  - (n  vector) 

filter  estimate  of  system  state  at  time  t^  after 
a measuren.ent  is  incorporated  - (n  vector) 

svstem  state  transition  matri;-:  from  time  t. 

1 - 

to  time  tj  - (n  X n matrix) 

covariance  matrix  of  the  filter  state  estimate 
_x(t^)  - note  that  the  and  '+'  convention  is 
used  here  also  - (a  x n matrix) 
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K(tj^)  = Kalman  gain  matrix  at  time  t^  - (n  matrix) 


F(t)  = systems  dynamics  matrix  defined  at  all  t - 
(n  X n matrix) 


G(t)  = system  noise  input  matrix  defined  at  all  time  t - 
(n  X s matrix) 


h(t^)  = measurement  matrix  defined  only  at  time  tj,  - 

(m  X n matrix) 


w(t)  " Gaussian  vhite  noise  vector  v;ith  statistics 


E I w(t)  ) = 0 

E I ”(t)  = Q(t)  5(t  - s) 


(s  vector) 


Q(t)  = positive  semi-definite  synmietric  noise  covariance 
matrix  - (s  x s matrix) 


v(ti)  = Gaussian  vdilte  noise  vector  sequence  v.’ith  statistics 

(m  - vector) 

E I v(t^)  I = 0 


E I v(tp  j ^ t.  = tj 


ti  ^ tj 


E(t^)  = positive  definite  syrmictric  noise  covariance  matrix 

(m  X m matrix) 


z(t^)  = measurem.cn t vector  at  time  tj^  - (m  vector) 


System  Dcscrip t i_oji 


The  system  is  described  by  tiic  following  state  eciuatlon; 
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c 


x(t)  = F(t)x(t)  + G(t)  w(t) 


(3-1) 


and  measurement  equation: 


z(ti)  = H(ti)x(t^)  + v(tp 


(3-2) 


Filter  Equations 


The  filter  state  estimate  x(t)  is  propagated  from  tine  t,  _ ^ to 
time  tj^~  by  the  equation: 


x(ti”)  = $(ti.  t . _ ^)  i(t.  . 1+) 


(3-3) 


and  the  covariance  propagation  is  given  by: 


'(t.-)  = <Kti,  ti  . i)  P(ti  _ 1+)  4>’^(ti,  ti  _ i)  + 


(3-4) 


X 

J <J>(t.,  t)  G(t)  0(t)  cJ(t)  4>’^(t^,  t)  dT 


'i  - 1 


(3-5) 


The  Kalman  gain  matrix  at  time  t^  is  given  bv: 

K(ti)  = P(ti")  ii'^(ti)  ii(ti)p(tr)n'^(tp  + R(ti)  j 

and  at  time  t^,  the  state  estimate  is  updated  by  the  eauation; 

K(tj+)  = x(ti-)  + K(ti)  r C(ti)  - lUti)  0-6) 

where  c(t^)  is  the  vector  of  measured  values  whicb  _z(ti)  assumes  at 
time  tj^.  The  covariance  matrix  is  updated  at  time  t^  bv  tae  equation. 


P(ti+)  = P(ti“)  - K(t^)  P(ti)  P(t^  ) 
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Equations  (3-3)  and  (3-4)  are  thus  the  propagation  equations  for 
the  state  estimate  and  covariance  respectively  and  equations  (3-6)  and 
(3-7)  are  the  update  equations  for  state  estimate  and  covariance  res- 
pectively. Initial  conditions  for  the  propagation  are: 


x(t^)  = E j x(t^)  ) 

P(to)  = E I [^(t^)  - x(to)J  [x(to)  -i(tQ)J^|  (3-8) 


Extended  Kalman  Filter  Eorriulation  (Ref.  13) 

The  Extended  Kalman  Filter  is  one  method  of  propagating  the  'ontiml' 
estimate  of  the  state  of  a non  linear  system.  In  the  above  linear  form- 
ulation , the  filter  estimate  was  indeed  optimal  since  the  equations  of 
motion  and  measurement  equations  were  totally  linear  and  the  basic  Kalman 
Filter  provides  the  optimal  or  best  possible  estimate  for  a linear  system 
driven  by  white  Gaussian  noise.  The  Extended  r'alman  Filt'ir  uses  a first 
order  linearization  process  and  hence,  the  estimate  v/ill  only  be  optimal 
providing  deviations  from  a nominal  trajectory  remain  arbitrarily  small. 

Gonsider  the  non-linear  state  and  measurement  eouations: 


j<(t)  = £j^x(t),  tj  + G(t)  w^  (t) 


(3-9) 


where  once  again,  w(t)  and  v(t^)  are  as  described  for  the  linear  formu- 
lation with  noise  covariance  matrices  0(t)  and  R(tj^)  respectively,  but 
in  this  case,  the  system  dynar:ics  is  non-linear  and  expressed  bv  the 
non  linear  function  fi  , ) .and  the  me.asurement  is  a non  linear  function 
of  the  state  x(t)  and  described  by  tlie  non  linear  function  ji(  , ).  Mote 
however  that  the  driving  noise  w(t)  is  still  additive  in  a linear  fasliion 
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respect  to  the  state  x and  which  is  evaluated  along  the  nominal  reference 
trajectory,  i.e, 

A 3 


*-  * 2?no 


3 X 


(3-15) 


x(t)  = 

Equation  (3-lA)  represents  the  first  order  approximation  to  equation 
(3-13)  and  propagates  from  the  initial  condition  j^(tQ)  which  is  modeled 
as  a Gaussian  random  variable  with  mean  (xq  - x^q)  and  covariance  P^. 
The  notation  F |^t;  XnoJ  implies  that  F is  a function  of  time  and  that 
F is  evaluated  along  the  nominal  trajectory,  which  is  a function  o ^ 2Sno‘ 
Similarly,  the  measurement  equation  can  be  approximated  to  first 
order  by  the  equation 


6£(ti) 


H [ti; 


6x(ti)  + l(ti) 


(3-16) 


where ; 


H 


2in(^i) 


3 h 


[x(ti),  ti] 


3 X 


x(ti)  = (3-17) 

and  the  notation  H j"  t^,  used  to  imply  that  H is  a function 

of  the  sequence  of  times  t^  and  is  evaluated  along  the  sequence  ^(t^). 

Equations  (3-lA)  and  (3-16)  thus  represent  the  linearized  varia- 
tional equations  for  the  system  and  therefore  the  theory  of  linear  fil- 
tering could  be  applied.  In  fact  if  the  variations  ^(t)  and  3z (t j^) 
remain  sufficiently  small,  v;hich  in  turn  implies  that  the  true  and  nominal 
state  trajectories  deviate  by  'sufficiently'  small  quantities,  t.hen  the 
results  of  the  application  of  linear  filtering  theorv  should  be  optimal.  The 
word  'sufficient'  is  of  course  relative  and  even  sniall  deviations  could  re- 
sult in  large  magnitude  errors. 


The  object  of  tiic  Extended  Kalman  Filter  is  to  obtain  the  state 
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through  the  matrix  G(t)  and  the  measurement  noise  is  also  additive. 

The  Extended  Kalman  Filter  formulation  assumes  that  the  noises  are 
white,  Gaussian  and  additive  in  the  same  way  as  the  basic  Kalman  Filter, 
although  the  syscem  dynamics  and  measurements  may  be  non  linear. 

Assume  some  nominal  reference  trajectory  is  available,  denoted 
as  3^(t),  which  is  propagated  from  the  initial  condition  ^n(to)  = 2^no 


by  the  equation: 


" l[iln(t),  t] 


(3-10) 


and  assume  also  that  associated  with  this  nominal  reference  trajectorv 
is  the  sequence  of  nominal  measurements: 


fn<4>  " h] 


(3-11) 


and  consider  the  perturbation  of  the  state  from  the  assumed  nominal 
reference  trajectory  such  that: 


6x(t)  = x(t)  - Xj^(t) 


(3-12) 


The  error  is  a stochastic  process  which  satisfies  the  stochastic 
differential  equation; 

^(t)  = i [ii(t),  tj  - tj  + G(t)  w(t)  (3-13) 

The  first  order  approximation  to  this  equation  usually  referred  to  as 
the  variational  equation  is: 


6x(t)  = F l^t;  J ;j<(t)  4-  G(t)  w(t)  (3-l-?i) 

F ^t;  >inoJ  ^ matrix  of  partial  derivatives  of  _f(  , ) with 
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estimate  21(^1"^)  then  relineariie  about  this  estimate.  Thus  as  soon 

as  a new  state  estimate  is  made,  a better  reference  trajectory  is  In- 
corporated into  the  system.  In  this  manner,  the  assumption  that  the 
deviations  from  the  reference  are  small  remains  valid  providing  the 
time  between  estimates  is  kept  small.  Now,  if  the  system  is  relinearized 
after  is  obtained,  then  the  error  state  ^(t^"^)  will  be  zero. 

Recalling  equation  (3-3),  rewritten  here  in  terms  of  the  error  state: 

4-  1")  “ ji,  t^;  xCt^"''))  6x(tj^  ) (3-18) 

A I 

wliere  the  notation  is  meant  to  convey  that  $ is  a function  of 
addition  to  t^  ^ and  t^.  It  is  apparent  that  if  j^(ti"^)  is  zero,  then 
_^(t^  +1”)  will  also  be  zero  since  equation  (3-18)  is  linear.  In  fact, 
using  the  notation  _^(t/t£)  to  indicate  that  the  estimate  of  at  tine 
t ^ ti  is  based  only  on  measurements  through  time  t^,  then  j^(t/t^)  will 
remain  zero  throughout  the  interval  j^t^,  t^  4 . 

Nov;,  considering  the  measurement  update  for  the  linearized  system 
at  the  next  m.easurement  sample  time. 

^(t^  + 1^)  = ^ 2^")  + K(t^  4 1)  ii(ti  + 1)  - H(t^  4 j)  i2i(ti  4 i“) 

= R(ti  4 1)  ^(ti  4 1) 

- K(ti  4 1)  i(ti  4 1)  - h x(ti  + 1/4)  • ti  4 1 (3-19) 

where  K(t^^  4 j^)  is  computed  using  matrices  evaluated  along  the  most  re- 
cent nominal  trajectory  x,(t/t^).  So  far,  the  state  deviation  has  been 
estimated  betv;een  measurement  Instants  as  zero  and  at  the  measurement 
update  point  as  given  by  equation  (3-19).  The  full  state  estimate 
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x(t/t^)  between  measurement  instants  t^  and  must  therefore 

be  given  by  the  solution  to  the  equation: 


x(t/tj[)  = ^ ^ 1 


(3-20) 


Since  the  deviation  is  zero  throughout  this  interval.  At  the 
measurement,  update  time  tj^  .j.  ] , the  state  is  given  by. 


x(ti  ^ +)  = x(ti  + i/ti)  + ^(ti  + 1+) 

(3-21) 

- _h[^(ti  + 1^  t^)  , ti  + l]  j 


which  is  the  state  estimate  update  equation  for  the  E:-:tendcd  Kalman 
Filter. 


Summary  of  P^'ojj^ay^c^^n^  Up_da_^e^^^^ 


The  equations  for  the  Extended  Kalman  Filter  are  summarized  as 
follows : 


Propagation:  The  state  estimate  and  covariance  are  propagateu  as; 

•^i  + 1 


£^^i  + 1 ^ j i.[ii.(t/ti)  , t]  dt 


i(t/ti)  = l[i(t/ti),  t]  from 


or  equivalently  by  integrating: 

the  initial  condition;  jiCtj/ti)  = ii^^i  ^ 


tf  to  t^  ^ ;i^  using 


^(t^  q-  T 


•)  = J(ti  + 1,  ti;i(ti'^))  P(ti+)  1''^(ti  + 1,  t^;  x(t>)) 

+ j Ht.  ^ ^,u£(ti+))  n(0  n(x)  gT(t)  t;  x(ti+))dT 


/.8 
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K Is  a function  of  that  estimate  also.  Similarly,  the  transition 
matrix  varies  as  a function  of  2I  and  thus  P is  a function  of  the 
estimate  ^ during  propagation.  This  therefore  is  one  major  difference 
between  tlie  basic  and  Extended  Kalman  Filter  formulations.  The  equations 
for  the  propagation  and  update  of  the  covariance  matrix  P are  coupled 
to  the  state  estimate  x. 


Application  to  Tracking  Problem 

The  purpose  of  this  study  is  to  examine  the  performance  of  a re- 
duced order  filter  model  of  the  system.  This  involves  carrying  out  a 
covariance  analysis  which,  will  be  described  in  the  next  section.  The 
covariance  as  a function  of  time  will  describe  the  filter  and  truth 
model  perfotT.iance  and  there  will  not  be  any  requirement  to  propagate 
the  actual  filter  estimate  _x»  However,  the  matrices  F and  H v.’hich 
result  from  linearization  of  a non  linear  functions  f(  , ) and  h(  , ) 
respectively  must  be  linearized  about  some  non-linear  reference  trajec- 
tory. For  this  reason,  the  non-linear  state  equations  of  motion  are  in 
fact  propagated.  Thus,  the  true  filter  would  use  the  matrix  F [t;  i(ti  _ 1+)] 
to  propagate  from  ^ to  t^  \%’here  J^Ctj;  _ is  the  initial  condition  for 

the  trajectory  segment,  up  to  measurement  time  t^,  along  v.’hich  F is  eva- 
luated. Similarly,  the  matrix  H [ti;  i(tj_  _ ^+)]  would  be  used  for  t’.ie 
true  filter  to  update  the  P matrix  at  time  t^.  For  tliis  analysis  ho'.;ever, 
the  matrices  F ^t ; and  H are  used.  The  reason 

for  this  is  that  }^(t)  is  not  available  in  the  covariance  analysis,  and 
to  obtain  x(t)  witii  one  run  would  not  suffice.  In  fact,  Monte  Carlo 
techniques  would  bo  re' uired  to  find  the  P-'iS  perform.ance  of  the  filter 
if  x(t)  were  used.  In  ti.is  case,  the  benefit  of  doin'’  the  covariance 
analysis  would  be  lost. 
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Thus,  evaluation  of  natrices  F and  H using  rather  than  J^(t) 

is  one  fundamental  limitation  to  the  covariance  analysis  but  necessarily 
this  limitation  must  be  accepted  and  it  should  be  recalled  that  the 
covariance  analysis  is  the  first  step  towards  i full  Monte  Carlo  analysis. 
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IV.  COVARI/uN'CE  /L\/\LYSIS  OF  SUCOPTI^IAI.  FILTER  DESIGN 


Objective 

Section  II  developed  the  true  system  state  and  measurement  models 
for  the  aircraft  to  satellite  tracker.  In  fact,  to  use  the  expression 
'truth  model'  to  describe  these  equations  is  Incorrect.  There  is  no 
way  of  predicting  exactly  wliat  the  precise  true  system  performance  v;ill 
be.  However,  the  equations  were  developed  ta'r  ing  into  account  all 
reasonable  system  disturbances  and  thus  represent  the  best  approximation 
to  the  'truth  model'.  The  resulting  model  has  61  states  and  would  there- 
fore be  impractical  to  implement  on  board  an  aircraft  wliere  comnutational 
speed  and  storage  capabilities  will  he  limited.  A search  will  thus  be 
conducted  to  find  a reduced  order  model  \;hich  will  adequately  model 
the  true  system.  This  will  involve  making  simplifying  assumptions  and 
will  result  in  a sub-optimal  design.  The  Extended  Kalman  Filter  design 
will  be  based  on  this  sub-optimal  model  and  it's  performance  -will  in 
turn  be  sub-optimal.  Under  those  circumstances,  a study  must  be  under- 
taken to  evaluate  the  subontimnl  filter  estim.ation  error  performance  and 
the  sensitivity  of  these  errors  to  incorrect  or  incomplete  d’.Tiamic  or 
statistical  modeling.  This  study  is  commoniv  referred  to  as  a sensirivitv 
analysi s . 

The  Ecuations  for  Sensitivity-  Analvsis  (Ref.  2 and  14) 

The  following  v.-ill  develon  tk.e  euuntions  for  the  sensitivitv  analvsis 

of  the  sub-optir.al  filter  design.  In  practice,  the  filter  estimates 

resulting  from  using  tlie  Extended  Kalman  Filter  r'i  th  a reduced  order 

system  model  would  be  used  to  provide  some  closed  loop  control  to  the 

system.  However,  in  order  to  sir'.nllfv  the  development,  tin?  effect  of 

such  control  inputs  will  be  ignored.  Reference  2 slio’..’s  how  the  equations 
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are  extended  to  include  control  inputs. 

Truth  Model  The  truth  model  equations  representing  the  most  detailed 
model  of  the  real  world  were  developed  in  section  II  and  are  written 
below  using  slightly  different  notation: 

Xg(t)  = Fg(t)  Xg(t)  + Gg(t)  Wg(t)  (A-1) 

where 


Xo  is  an  n - vector  denoting  the  true  state 

— o I 


Fg  is  an  x n^  system  matrix 


Gg  is  an  x m^  gain  matrix 


Wg  is  an  m^  vector  of  white  Gaussian  noise  inputs  with  zero 


mean  and  variance  E 


Note  that  equation  (4-1)  is  in  fact  linear  whereas  the  truth  model 
equations  are  not.  Equation  (4-1)  could  be  considered  to  represent  the 
error  state  system  model  described  by  equation  (3-14)  section  III. 

Since  this  is  a linear  equation,  the  Kalman  Filter  theory  can  be  applied 
providing  that  perturbations  from  an  assumed  trajectory  are  small  so 
that  linear  effects  dominate. 

Similarly,  the  sensitivity  analysis  to  be  described  here  assumes 
linear  equations  and  could  therefore  be  applied  to  the  linearized  error 
state  equations  developed  in  section  III  within  the  region  of  small 
perturbations. 

A set  of  discrete  measurements  art  available  at  times  t^  and  can  be 
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r- 

V. 


described  by  the  equation: 

ZgCti)  = Ho(ti)  xg(ti)  + VgUp 

which  is  analagous  to  equation  (3-16)  section  Hi,  and 
Zg  is  an  r - vector  of  measurements 
Hg  is  an  r X n measurement  matrix 


(A-2) 


vg  is  an  r - vector  of  Gaussian  vmite  noise  inputs  vitli 


zero  mean  and  variance  E 


Xs^t.)  = Rg(ti)  J |j 


Filter  Hodel 


The  filter  model  is  defined  to  be  the  reduced  order  model  to  ’’nich 
tlie  Extended  Kalman  Filter  will  be  applied.  Again,  this  is  assumed  to 
be  linear  and  tlius  the  resultant  sensitivity  equations  will  be  valid 
only  in  a region  of  small  pertur’natlons  about  the  nominal  trajcctorv. 


wnere : 


Xp(t)  = Fp(t)  Xp(t)  + G„(t)  Vp(t) 


(A-3) 


X is  an  n - vector  denoting  tl'.c  filter  state  (n  < n ) 
-F  2 2 1 


Fv  is  an  n x n svstc’-i  '"atrix 


2 2 • 


Gt7  is  an  n.  x n-  gain  natri:-: 

i cl 


v?p  is  an  m2  vector  ol”  wlilte  Guassian  noise  inp’i''s  x.’i  tli  zero  mean 


and  covariance:  E 


wp(t)  VpT(0 


n^(t)  c(t  - -) 


Tlic  filter  i.u- asurenent  eeuation  is: 
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( 


where 


Zp  is  an  r - vector  of  measurements 


Hr>  is  an  r X n.  measurement  matrix 
F 2 

is  an  r - vector  of  white  Gaussian  noise  inputs  with,  zero 

*~r 

mean  and  covariance  E 


Applying  th  • basic  Kalman  filter 
the  filter  estimate  betv.'een  measurements  is  given  bv: 


- Rp(tjL)  j 


eqt;ations  to  the  above  filter  model, 


Xp(t)  = Fp(t)  xp(t)  (^4-5) 

with  associated  covariance  matrix  satisfying  the  eouation: 


Pp(t) 

Fp(t)  Pp(t) 

+ Pp(t) 

Fp'T(t)  + Gp(t)  Op(t)  Gp^Ct) 

(A-6) 

Def inin 

g tj^  and  t^"*"  as  before 

and  after  a measurement  incor 

poratlon 

at  time  t^, 

then  at  a measurement  u 

pdate,  PpCt)  3re  given  bvt 

Kp(ti) 

= Pp(ti")  Up' 

^■(ti) 

p(tj)  rp(tp)  + p.p(t. 

2,,(ty) 

= Xp(t^  ) + 

Kp(tp) 

PrCnb 

Fp(ti  ) 

Ilp(ti)  Pp(tp“) 

(A-3) 

where  : 


Xp(t)  denotes  the  filter  estimate  of 

Pp(t)  denotes  the  covariance  matrix  associated  with  Xp(t) 
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Note  in  equation  (4-7)  the  use  of  the  vector  of  measured  values 
Cs(t^),  since  the  actual  ncasurenents  will  in  fact  be  taken  from 
the  true  system.  Now,  if  the  state  vectors  Xp  and  are  arranged 
such  that: 


T A r T 

x„  = T X-  and  T = I (n  x n ) 

-t  S 2 2 i 


0((nj  - n^  X n^) 


(4-9) 


then  an  error  vector  e(t)  can  be  defined  such  that: 


e(t)  = Xs^^^)  - 


(4-10) 


Note  that  there  is  a loss  of  generalitv  in  this  assumotion,  the 
filter  model  states  would  not  in  general  be  selected  truth  model  states. 
Rather,  '"he  filter  states  would  be  linear  combinations  of  the  truth  model 
states,  however,  in  practice  it  is  usual  that  the  filter  model  is  in 
fact  the  truth  model  with  selected  states  removed.  Tf  this  is  not  the 
case,  then  the  T matrix  could  be  defined  differently  without  c'nan  ing 
the  final  results. 

The  objective  of  the  sensitivity  analysis  is  to  examine  the  pro- 
pagation of  the  error  vector  ^(t)  with  time  and  the  pronagation  of  tlie 
covariance  matrix  of  e(t)  defined  as: 


P,,p(t)  = E e(t)  eVt) 


Nov.',  j^(t)  i.s  a vector  c-xnressing  the  eri'or  committed  b''  us'!ng  the 
particular  filter  model  and  Pp^j(t)  e:<pnsses  the  covariance  of  that 
error.  T'nc  haiman  Filter  covari.ince  Pp  is  also  a measure  of  tlic  error 
in  tlie  estimate  but  m.av  not  ncces‘..ar i 1 v reflect  true  nerform.nnce  of 
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the  filter.  The  sensitivity  analysis  therefore  is  a method  of  comparing 
the  filter  estimate  xp(t)  witli  the  true  system  state  propa- 

gating ^(t)  and  PggCt),  and  thereby  determining  the  true  error  obtained 
by  using  a particular  filter  formulation.  The  evaluation  of  Pg^  and 
Pp  is  commonly  referred  to  as  a Covariance  Analysis  while  the  examination 
of  e(t)  over  an  ensemble  of  runs  is  usually  called  a Monte  Carlo  analysis, 
In  order  to  study  the  behaviour  of  £(t)  , Pec(t)  , and  Pp(t)^the  augmented 
state  vector  y(t)  is  formed  such  that: 


y(t)  = |e(t) 


(4-11) 


where  y(t)  is  an  n^  + n^  dimensional  vector. 

The  differential  equation  for  this  augmented  state  vector  is 
therefore : 


y(t)  = e(t) 


Hs  - T Fp  xp 
Fp  Xp 


(4-12) 


where  the  time  subscripts  on  the  right  side  are  dropped  for  claritv 
Rewriting  equation  (4-12)  gives: 


v(t)  = 


-S  -s  ~ fp  2ip  + Fg  T Xp  - fg  i xp 


Fc  T XT 


Fp  Xp 


(4-13) 


T Xp)  + (F^  T - 


T Fp)  Xp  + Gp  Wp 


Fp  Xp 
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£ + (Fg  T ~ T Fp)  Xp  + w 


F„  x„ 
F -F 


which  can  now  be  written  In  matiix  form  as; 


(Fp  T - T Fp) 


y(t) 


y(t>  + i'S  (4-14) 


y(t)  = ^ y + Gw 


with  F and  G defined  as  in  equation  (4-14) 


Betv  een  measurcr.ents , the  covariance  of  y(t)  propagates  according 


to  the  differential  equation: 


P = F P + P + G Q g"^ 


where  Q = Qs  ^nd  F and  G are  defined  above. 


P(t)  = 


Pee^*-^  Pj2^^^ 


PjiCt) 


and  P (t)  is  eeuivalent  t'  t’'.e  natrix  i'r(t)  from  tlie  ’’rJman  Filter 
22 


equations  (4-0)  ami  (4-8) . 


At  a nca.suremien t imdate,  ^;ill  ci'.ange  accordinp  to  equation 


(4-7),  v.’liile  Xr  ^.’ill  not  change  since  control  inr>uts  are  not  cons : ecrec! , 


+ - ...  - 


-S  “ 


(4-lb) 


xp^  - Xp  + ‘ F — f ^ 


(4-10) 


W\ 
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where  tlic  - and  4-  signify  before  and  after  incorporation  of  a 
measurement  respectively. 


+ _ 


— F 2Ss 


-F 


(4-17) 


and  since: 


e+  = Xg+  - T x/ 


" I ^r 


[* 


+ >'f^”s  2F  + '1s'> 


25s"  ■ 25f~  ~ T Kp  llg  Xg"  + T Kp  !Ip  Xp”  - T Ep  Vg 


= ^25s”  “ 2Sf'^  ■ ”s  - T Xy~) 


+ T K p (Hp  - Hg  T)  Xp"  - T Kp  V, 


= (I  - T Kp  Hg)  _e"  + T Kp(l!p 

and  from  (A-17), 


^•s  22f  “ ’''f  Vg 


r.  + 


25f  = 25p  + Kp  Eg  xg 


Kp  Up  Xp  + Kp  Vg 


+ 


Xp  + ICp  iJ^  Xs 


!:p  Ep  T Xp“  + Kp  Hp  T Xp' 


— Kt7  H^,  Xp  + Kt7 


T "p 


Kp  1!  (xg  - T X,,  ) + (I  + K„  llg  T - Kp  Hp)xr"  + Kp 
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= Kp  Ug  ^ + 


(I  + Kp  II3  T 


Kp  Hp)  _Xp"  + Kp 


and  thus  the  augmented  state  vector  after  incorporation  of  a measure- 
ment is  given  by: 


I - T Hg  T K^  (Hp  - Hg  T) 


Kr  IL 
F S 


I + Kp  I!g  T - Kp  Hpj 


+ 


(4-18) 


or 


y = A V + B Vg 

where  matrices  A and  B are  as  defined  in  eauation  (4-18)  . 

The  covariance  matrix  ?(t)  is  updated  by  a measurement  as  follows: 


[ + +T 

V V 

, P 1 

1 

= F,  I (A  y + Bvg)(A  v + Bv,,)  T 


p"^  = E I (A  y + B Vc.)  (y  a"^  + v^,”^  b"^) 


= E I A v V a"^’  } + E { Vc  V ^ A 


-T  ,T 


+ E 1 

[ ^ j 

|.  E j 

^ B Vg  Vg  B 1 
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.-  . -T  .T 


-T  ,T 


T pT 


A n j y y A"  + B E j y " A^  + A E { y“  } B 


+ B E ’ Vs 


B 


(4-19) 


Now,  the  noise  vector  is  uncorrelated  by  hypothesis  with  the  state 
and  the  state  Xp  and  therefore  the  transformation  of  Xp,  T Xp.  Similarly, 
the  estimate  Xp  and  vg  are  uncorrelated  which  imnlies  that  Vg  and  v 
are  uncorrelated.  Thus  the  second  tlie  third  terms  in  enuation  (4-19) 
above  are  zero  leaving : 


+ - T 

P = A P A 4-  R B 


(4-20) 


Summary  of  Projiajiation  and  Update  Equations  for  Covariance  Analysis 

The  equations  for  prcpapating  and  undatinp,  the  covariance  matrix  P 
are  sumiaarized  as  follov/s: 

Propagation : 

P(t)  = F(t)  P(t)  + P(t)  F"^'(t)  + G(t)  Og(t)  G’T(t) 


where 


P(t)  = E j y(t)  yT(t) 


y(t) 

e(t) 


1 

e' 


i"^t)  x;^(t) 


(x^(t)  - T 2^(t)) 


[i  o]- 


Fg(t)  (^g(t)  T 


T F^(t)) 
F 


Fp(t) 
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C. 


( 


Git) 


A 


Gs(t) 


0 


Update : 


P'^(t)  = A(t)  P~(t)  a'^(c)  + B(t)  Rg(t)  s'^^Ct) 


where ; 


A(t) 


I - T Kp(t)  llgCt)  T Kp(t)  O^p(t)  - Hg(t)  T) 


Kp(t)  llg(t)  I + Kp(t)  Hg(t)  T - Kp(t)  llp(t)J 


A 

B(t)  = 

Application  of  Covarl an c e_  An alysis  to  F.xtondc ^ Kaltnan  Filter 

The  problem  under  study  is  non-linear  and  in  section  III  it  was 
sho'./n  that  the  equations  could  be  linearized  about  some  reference 
trajectory.  Application  of  linear  filtorinp  theory  to  the  linearized 
equations  resulted  in  the  P.xtended  Kalman  Filter.  The  above  eauations 
for  propagation  and  undate  for  the  matrix  P(t)  arc  linear  hov:cver  and 
it  is  necessarv  to  examine  tiie  method  of  implementation  of  tliese  eoua- 
tlons  to  a non-linear  problem.  T'ne  state  enuations  for  bot!i  truth  and 
filter  models  must  be  linearized  about  the  reference  trajectory.  The 
resultinp,  linearized  equations  will  bo  used  in  the  above  covariance 
analysis  equations.  Tlie  results  of  tlie  analysis  will  therefore  be 
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highly  dependent  on  Che  assumption  of  linearity,  and  in  order  for  these 
assumptions  to  remain  valid,  the  interval  between  measurements  must  be 
made  small  compared  to  the  system  truth  model  time  constants,  and  per- 
turbations about  the  assumed  nominal  trajectory  in  the  interval,  must 
be  small. 

Finally,  it  should  be  noted  Chat  the  trajectory  linearization  is 
carried  out  about  In  a practice,  if  linearization  were  required 

then  x,p(t)  would  be  used.  However  neither  will  be 

identical  to  the  true  system  state  which  is  never  available  and 

ideally  linearization  would  always  be  carried  out  about  Xp(t). 


( 
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V.  INITIAL  CHOICE  OF  FILTER  MODEL 


Objective 

The  development  of  the  true  system  state  and  measurement  equations 
in  section  II  resulted  in  a 61  state  truth  model  v;hich  used  5 measure- 
ments. The  objective  of  this  section  will  be  to  find  a filter  model 
by  simplifyinp;  the  truth  model  equations  and  thus  reducing  the  model 
state  dimension.  The  filter  model  will  tlicn  be  evaluated  by  the  co- 
variance  analysis  method  described  in  section  IV. 

Filter  Model  at ^ Eeuatf  ons 

Examination  of  the  truth  model  state  equations  summarized  r.t  the 
end  of  section  II  shows  that  the  basic  system  dynamics  is  renresented 
by  the  states  1 to  6 and  9 to  lA.  States  7 and  8 v?cre  introduced  to 
model  the  uncertainty  in  drap,  and  solar  pressure  perturbations  respec- 
tively due  to  the  veliicle  size  and  shape.  The  remaining  states  15  to 
61  were  introduced  to  model  measurinp  device  uncerta'nties  in  tlie 
measurcm.ents  of  angular  trach.irg  rates,  trachcr  acceleration,  range, 
and  tracker  angular  deviations. 


Simplificaticn  of  Eeuationa  1 to  6 

Trutli  model  state  equations  1 to  6 describing  the  propagation  in 
of  the  vehicle  orbit  are: 


= V, 


X„  = X, 


X.  - X. 


(5-1) 

(5-2) 

(5-3!' 
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X, 

® Agi 

+ 

Adj 

+ 

As  2 

+ 

Afflj 

+ 

Apj 

+ 

(5-4) 

^5 

" Ag2 

+ 

Ad  2 

+ 

As  2 

+ 

Affl2 

+ 

A?2 

+ 

(5-5) 

^6 

“ Ag3 

+ 

Adj 

+ 

As  3 

+ 

Affij 

+ 

Apa 

+ 

(5-6) 

Consider  the  low  orbit  problem  which  is  investi'^ated  in  particular  in 
this  study.  The  basic  orbital  profile  actually  tested  serves  as  an 
illustrative  example.  The  vehicle  considered  is  in  a polar,  circular 
orbit  with  an  altitude  above  the  earth's  surface  of  approximately  200  km. 
For  this  orbit,  consider  a typical  small  vehicle  with  a ballistic 
coefficient  of  0.015  m^/k"  and  a solar  pressure  coefficient  eouivalent 
to  a vehicle  with  a projected  surface  towards  the  sun  of  approximately 
10  m2.  Under  these  conditions,  the  terns  in  equation  (5-4)  for  example 
would  have  deterministic  values  of: 


Agj  n -7.55  m/s2  - Acceleration  due  to  full  rravity 

Adj  «=  -9.0  X 10”^  ro/s2  - Drag  perturbation 

Asi  = +2,0  X 10”^  m/s2  - Solar  perturbation 

Amj  = +5.0  X 10“^  m/s2  - Lunar  perturbation 

Api  = -2.0  X 10  ni/s2  - Solar  pressure  perturbation 

where  tlie  sun  and  moon  are  positioned  for  worst  case  effects,  and  the 
vehicle  is  lying  in  the  Greenwich  meridian  at  a latitude  of  approxi- 
mately 30°H.  The  white  noise  driving  term  accounts  for  unmodeled 
effects  sucli  as  deviations  in  atmospheric  density  from  tlie  model  and 
unmodeled  gravitational  terms.  Hj  would  typically  be  zero  mean  white 
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noise  with  a distribution  standard  deviation  of  approximately  10  \/s^. 

The  two-body  point  mass  acceleration  accounts  for  approximately  -7.548  m/s"^ 
in  Agj.  The  appropriate  terms  driving  equations  (5-5)  and  (5-6)  have 
similar  relative  magnitudes. 

The  model  proposed  for  the  filter  therefore  assumes  a two-body 
orbit  and  neglects  drag,  luni-solar  perturbations  and  the  polar  pressure 
perturbation.  For  long  orbital  times,  this  v;ouid  of  course  be  a poor 
approximation,  but  a typical  trac’xing  pass  with  the  assumed  profile 
lasts  for  only  l/20th  of  the  orbital  period.  The  errors  introduced  by 
these  approximations  are  accounted  for  by  increasing  the  strength  of 
to  give  a distribution  standard  deviation  of  approximately  2 x 10  ^ m/s^. 
The  resulting  state  equations  are: 


X = X 


X = X 


-b®  Xi 


+ w 1 


X, 


•b®  -2 
r-  3 


+ h'. 


r 3 
•■v 


+ W„ 


(5-7) 

(5-8) 

(5-9) 

(5-10) 

(5-11) 


(5-12) 


v;here  p„  is  the  earth  gravitational  constant  and  r is  the  distance 

® V 

from  earl'n  center  to  vehicle; 


r 


V 


+ 


+ 


■■3 
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Simplification  of  State  Equations  9 and  10 

The  truth  model  state  eauations  9 and  10  ire: 


-1  s 


- 2 Vr 


R 


U)  +0)  COrr, 

LSy  LS^ 


6e 

R 


(5-13) 


A-fc-  ^ to*  r»  I in  tO*T»  — ” i ^tOrrl  1/ 

X ^^^7  L V ^zJ 


(0 


LS* 


1 2 V, 

^ “ ~T~ 


- ‘^LSy 


{ “ T \ ~ ^Ty  - 


(5-14) 


I 


i 


( 


where  the  bracketed  terms  { • } result  from  usinp  tracker  accelerations 

^rv-»  K-  » K-  3nd  angular  velocity  tOm  rather  than  true  line  of  sight 
A i-Y  '-z  ' -^X 

parameters  ^relv’  ^rel  ’ “LSv*  accuracy  tracking, 

the  angular  deviations  5e  and  6n  will  have  lagnitudes  on  the  order  of 
10  rad  or  smaller.  For  the  profile  under  test  therefore  the  bracltetod 

terms  have  magnitudes  near  10  ^ ^ v/hich  arc  approximately  5 orders  smaller 

• • 

tiian  the  magnitudes  of  and  Thus  for  the  filter,  the  bracketed 

terms  are  replaced  by  zero  mean  wh.ite  Gaussian  driving  noises  each  having 
a 1 - sigma  value  of  approximately  10  The  resulting  filter  model 

equations  are: 


(i) 


LS^ 


= 


-Ar 

R 


2 Vi 
R 


+ (Jj. 


I-Sz  “'Tx 


W, 


(5-15) 


2 Vr 

i.  c 

R '“’Z 
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‘X 
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Tlie  rer.iainlnf!  state  enuations  are; 


6 ri  “ Qj  ~ ~ 6 e uj'p 

LS.,  S 


6c  = w 


LSy  “ *^Ty 


R = V. 


(5-17) 

(5-lR) 

(5-19) 


Vr  = 


■*■  ‘"Is.  ^ 


Equation  (5-20)  can  be  sir'plificd  by  rcn.oviny  the  tcrr.s  *n 

and  6c  Aj-_.  Since  in  and  6c  are  snail,  the  t'.’o  ter^^s  liave  na”nit;idcs 

• • 

5 orders  snallcr  than  Vj-.  The  filter  state  etiuation  for  Vj.  L;ms  bccones 


A + R(o;jSy^  + + '-C 


(5-21) 


where  V.'^  is  a vEnite  Gaussian  noise  \n‘th  a distribution  standard  deviation 

_ 5 

of  approximately  5 :<  10  m/scc. 

Thus  far,  tlie  orbital  d'.manics  have  been  sir’plified,  and  the  state 
equations  for  the  true  propagation  of  tl;c  line  of  siyht  anpular  velocities 
and  Vj-  have  been  simplified.  As  a result,  tb.c  first  1-5  truth  i.'.cdcl  state 
equations  are  reduced  to  12  filter  nodcl  state  equations  \;here  tne  too 
equations  for  tiie  ballistic  coefficient  and  solar  pressure  coefficient 
are  no  longer  ri;quired. 


Til  ter  Xodel  he_asure;;>- nt  Tnuationn 

Tlie  systi'P,  truth  ".ode  1 r.easurer’.-nl  ecuations  are  sumr  ari red  in 

section  II.  TItu  9 ecuations  were  ret'.uced  to  5 Ic'’  cons  ider  ine  tne 

surei.out  of  ‘‘t,  , , and  A...  to  lie  narareter  i-.ea.surom.'nts  wl.ich 

‘ X X ‘ Y ‘ X 

could  he  ineorjiorated  into  ti.e  state  equation''..  The  ro.asure:  en  t ic  na- 
tions are  ail  similar  in  that  eacn  er-im  t i rr.  renr>  ■ ■ ei.  i.  s a • ,ea.''.u;  e:"''nt  of 
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the  true  quantity  corrupted  by  other  factors.  For  example,  the  measure- 
ment ecuation  for  Wn.  is  repeated  below; 

3 

° “Ty  BgsfY  ^ BgmY^  + Cg^ 


+ j^A  Cgm^  V?Y 


(5-22) 


In  this  equation,  u>^.  is  the  unknovm  quantity  to  be  micasured.  The 
remaining  temns  are  non-detcrministlc . The  term  Bgsfy  ^Xy  pro- 

duct of  a random  bias  and  the  deterministic  but  uuknoirn  quantitv  ujXy  • 

Thus  the  product  is  also  non-detcrministic.  Cg^,  is  modeled  as  a first 
order  exponentially  time  correlated  random  variable.  In  fact,  there 
are  four  types  of  quantity,  determ.inistic , random  bias,  first  order 
exponentially  correlated  random  variable  and  pure  wk.ite  noise. 

For  the  truth  model,  in  the  absence  of  better  information,  t'.ie 
random  bias  terms  are  chosen  to  have  ^cro  mean,  i.e.  x = 0,  with 

variance  derived  from  experimental  data.  The  gyro  drift  parameters 
would  also  be  derived  using  experimental  data.  The  wliite  noise  teiTi 
V2  accounts  for  unmodeleo  effects  such  as  higher  order  non-linearities. 

For  the  filter  model,  it  is  assumed  that  in  all  tlie  measurement  equations 
the  total  effect  of  the  non-ceterministic  terms  can  be  accounted  for  bv 
a simple  white  noise  added  to  tlie  determdnistic  term  in  each  eouation. 

The  white  noise  is  (lajssinn,  x/itli  zero  mean  and  variance  chosen  to  be 
approximately  equal  to  t’ne  variance  of  the  sum  of  all  the  non-deteministic 


terms. 


In  practice,  th.e  additive  white  noise  term  increases  the  uncer- 


tainty in  tiie  meas;-rer;ent . If  the  above  filter  r'.easurerent  model  giver. 
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poor  pe r f ortnanco  in  die  covari.nice  annlvr.iG,  it  rr.ny  be  possible  to 
increase  the  varir.nce  of  ti.e  \.-'.iitc  ncd.c  furtlier,  thus  indicating;  addi- 
tional unccrtaiatv  in  the  r.easurernent  model.  A1  to rna t i vc i •/ , the  model 
could  be  cl'.anrcd  to  include  just  die  '’vro  drift  terns  for  exannle. 

As  a first  attempt  at  modeliiv.;  ’no’-’ever,  the  additive  viiitc  noise  model 
tins  die  simplest  form. 

Summary  of  State  _an_d  J^iev-snreren t ncaa t i ons 

L'sinji  tiie  simple  measurement  models  described  above,  tlie  filter 
state  equations  and  measurement  count  ions  are: 


State  r.quattons 

(1) 

• 

Xi  = 

Xi, 

(2) 

X2  = 

^5 

(3) 

X3  = 

tr 

A . 
t) 

W 

-^©  Xi 
r 3 

+ Wj 

(5) 

^5  = 

-Ug^X2 
r 3 

+ '-'2 

(6) 

\ = 

-b0  X3 
~'"3“ 

+ W3 

rv 


( 


(7) 


(8) 


i Ar 

R 


^'LSz%  + 


I A 
R 


2 V 


- '5 
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CJ)  i!n  = 


r 


7. 


- 6 c w-p 


(10)  6 c = u,  + 6n 

(11)  R = Vf 


(12) 

^'r  = 

Lhy 

Mea.surePQ 

nt  I'ouations 

(1) 

m,, 

— (jjrp  "4“ 

Vl 

(2) 

‘'’Jly 

^'2 

(3) 

‘"‘■IZ 

= “Tz  + 

(4) 

At 

hpi 

+ V, 

(5) 

= A^ 

(6) 

'^7 

II 

+ V, 

(7) 

6c\j 

= 5c 

+ V7 

(8) 

= K2  5p 

+ Ve 

(9) 

pi 

pci 

11 

+ Vg 

The  measurements  of  A™  , 

, Apj,  , 
Y 

"LS, 


■)  + Wp 


constitute  measurements  of  system  parameters.  The  measured  narameters 
car.  thus  be  substituted  into  the  state  equations  so  that  the  actual 
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mearuircr.cnt  cqu.ition  uill  not  bo  njcd  nn  part  of  t ie  filter  rr.easurrnent 

model.  I.'ov:,  if  tliia  is  so,  tb.ore  is  no  real  need  for  the  simplified 

m.casurem.out  m.odcls  described  by  equations  (1),  (,1),  (3),  and  (6)  except 

for  t'ne  purpose  of  linearization.  In  linearizinr  t!ie  state  equations, 

account  must  be  taken  of  the  fact  tiiat  a measurei'en  t is  in  fact  a 

linear  or  non-linear  combination  of  system,  states.  Thus  in  order  to 

use  the  12  state  m.odel,  the  sim.ple  measurenent  m.odel  must  be  assumed. 

The  remaining,  measurements  are  direct  r.'asurements  of  states  of 

the  svstem,  or  in  the  case  of  and  m,,,  , pseudo-measuren ents  of  states 

7. 

of  tliG  system.  Equations  (2),  (3),  (7),  (8),  and  (9)  constitute  the  fil- 
ter model  m.easurement  vector. 

Appendix  C siiovs  hou  the  state  and  m.easurement  equations  of  the 
filter  model  are  lineari.zed  for  application  to  a covariance  analysis 
of  the  Extended  Kalman  Filter. 


< 
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VI.  RESULTS 


Test  Sluiulatlun  Data 

Appendix  D lists  t)ie  truth  model  simulation  parameters  used  for 
the  initial  evaluation  of  tlie  filter  model.  The  data  corresponds  to  a 
typical  set  of  measuring  instruments.  Some  simulation  parameters  were 
changed  to  improve  the  measuring  instruments  to  'state  of  the  art'  quality, 
and  the  filter  model  reevaluated.  The  actual  changes  will  be  discussed 
later. 

Test  Objective 

The  primary  test  objective  was  to  demonstrate  that  good  performance 
can  be  obtained  using  the  filter  model  described  in  section  V under 
varying  conditions.  These  conditions  were  representative  of  differing 
qualities  of  measuring  instruments.  In  order  to  achieve  this  objective, 
the  filter  model  was  first  'tuned'  against  the  set  of  sim.ulation  instru- 
ment specifications  described  in  Appendix  D.  The  process  of  tuning 
involves  adjustment  of  the  Q and  R covariance  matrices  in  the  filter 
model,  often  by  trial  and  error,  until  satisfactory  performance  is  ob- 
tained. Conceptually,  the  tuned  filter  is  the  best  representation  of 
the  truth  model,  by  the  simplified  filter  model.  Once  the  filter  model 
had  been  tuned,  and  evaluated,  some  of  the  measuring  parameters  were  then 
changed  in  the  truth  model  and  the  filter  model  retuned  to  account  for 
the  changes. 

Tuning  the  Filter  Model 

The  covariance  analysis  method  described  in  section  IV  compares  the 
true  estimation  error  variances  resulting  from  the  use  of  a particular 

filter,  with  the  error  variances  predicted  by  the  filter  itself.  Thus, 
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Riven  a state  vector  estimate  x(t)  wliere  the  true  state  is 
error  is  normally  expressed  by  the  covariance  matrix: 

P(t)  = c|  [l-(c)-^t;^^^  J [li(L)  - Xj.(t)J 

Since  this  matrix  may  be  of  largo  dimension,  it  is  usually  more  con- 
venient to  examine  the  square  root  of  each  diagonal  element  of  the  matrix. 
Thus  the  error  in  Xj(t)  is  given  by: 


which  is  the  i - sigma  value  (standard  deviation)  for  the  error  in  x,(t). 
Denoting  the  true  error  in  the  estimate  of  a state  as  the  system  error, 
and  the  error  preducted  by  the  filter  as  the  filter  error,  then  the 
objective  of  tuning  the  filter  model  is  to  ensure  that  the  system  error 
and  filter  error  have  very  nearly  the  same  magnitude.  It  is  quite  pos- 
sible for  the  system  and  filter  errors  to  simultaneously  diverge,  indi- 
cating an  unstable  error.  Even  in  this  circum.stauce  the  filter  is  still 
tuned,  provided  the  two  magnitudes  are  equal.  In  practice  it  is  usual 
to  tune  the  filter  so  that  the  filter  error  standard  deviations  never 
underestimate  the  system  error  standard  deviations.  In  this  way,  the 
filter  model  accurately  represents  or  slightly  overestimates  the  real 
error  and  therefore  allows  some  margin  of  uncertainty.  Fig.  6 and  7 show 
a typical  situatior  where  the  filter  error  for  X(14) , which  is  the  range 
rate  Vj->  converges  after  100  seconds  to  approximately  1.5  m/sec,  whereas 
the  system  error  is  in  fact  2 m/sec  after  100  seconds.  In  this  case,  the 
filter  is  underestimating  the  real  error  and  although  its  performance 
appears  good,  in  reality  it  may  not  be  acceptable.  The  process  of  tuning 

tlie  filter  is  somewhat  arbitrary  in  that  several  variables  can  be  ad- 
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Fig.  7 System  Range  Rate  Error  Standard  Deviation 


GA/i;H/7A-3 


juGted.  For  cxanplc,  the  initial  condition  cn  the  variance  of  a state 
will  affect  its  transient  bcliaviour,  the  iricasurcn'cnt  and  state  driving 
noise  covariances  .’ill  affect  both  the  tran.'^ient  and  steady  state  beha- 
viour and  in  general  tliere  will  be  one  set  of  conditions  which  produces 
the  best  performance.  This  set  of  conditions  can  be  highly  interdependent 
so  that  the  process  of  finding  the  correct  values  usually  requires  an 
element  of  trial  and  error 

Transient  Behaviour  of  Filter 

The  transient  behaviour  of  the  filter  depends  on  three  factors,  the 
choice  of  initial  conditions,  the  neasu’*ement  noises,  and  the  state 
equation  driving  noises  for  the  filter  model. 

Initial  Conditions  The  choice  of  initial  conditions  on  both  filter 
error  and  system  error  can  severely  affect  the  transient  behaviour  of 
the  filter  and  can  in  fact  cause  divergence.  Figs.  8 and  9 show  the 
behaviour  of  the  filter  and  system  errors  respectively  over  a 200  second 
time  interval.  The  state  is  the  inertial  satellite  position  element  Xj. 
The  tilter  error  initial  condition  -yjp  j ^ (^q)  was  chosen  as  100  km  while 
the  system  error  initial  condition  was  chosen  as  zero.  The  initial 
transient  subsides  after  approximately  120  seconds,  and  both  curves 
begin  to  show  a divergent  characteristic.  It  is  interesting  to  note 
that  during  the  divergence,  the  filter  appears  to  be  reasonably  vrell 
tuned  in  that  both  curves  show  similar  magnitude  errors,  but  the  filter 
is  overestimating  the  error  by  about  20%.  In  this  case,  the  divergence 
is  not  caused  by  the  poor  choice  <f  initial  conditions.  Figs.  10  and  11 
show  the  same  state  Xj  with  a different  set  of  initial  conditions  on  the 
filter  and  system  errors  respectively.  Again,  the  divergence  is  apparent. 
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Fig.  8 Filter  Xj  Position  Error  Standard  Deviation 
with  Initial  Condition  of  100  km. 
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and  the  initial  transient  beliaviour  is  r.uch  improved. 

Measurcrenc  and  Driving  .’oises  Consider  the  state  wliich  is 

the  line  of  siglit  angular  velocity  along  the  line  of  sight  y - axis. 
Appendix  C gives  the  state  equation  driving  noise  standard  deviation 
as  10“^^  rad/sec2  and  the  measurement  noise  standard  deviation  as 
1-6  X 10~^  rad/sec.  These  values  x;ere  derived  by  ■nsidering  the  truth 
model  simulation  data  in  Appendix  !',and  compensating  for  the  effect  of 
all  the  simplifications  from  truth  model  equations  to  filter  model  equa- 
tions. Using  these  two  values,  the  filter  diverged  rapidly.  Several 
test  runs  were  made  in  which  the  noise  figures  ver.  adjusted  to  improve 
performance.  Figs.  12  and  13  illustrated  tlie  behaviour  of  the  filter 
using  a driving  noise  standard  deviation  of  2.7  x 10“^  rad/sec  and  a 
measurement  noise  standard  deviation  of  6*5  x 10~®  rad/sec.  In  this 
case,  an  oscillatory  transient  occurs  with  a 40  second  period  and  100 
second  settling  time.  By  further  adjustments,  the  transient  was  almost 
rem.oved.  Figs.  lA  and  15  show  the  final  performance  curves  v;here  the 
driving  noise,  standard  deviation  was  5 x 10”^  rad/.sec^  and  the  measure- 
ment noise  standard  deviation  v;as  2 x 10”®  rad/sec.  The  example  illus- 
trates that  it  is  often  necessary  to  carry  out  very  fine  adjustments  to 
tune  the  filter  model.  Figs.  lA  and  15  v'ere  obtained  after  8 distinct 
adjustments ,v;here  each  adjustment  required  a computer  run  to  show  the 
performance.  Also,  it  is  sometimes  necessary  to  increase  the  strength 

of  the  state  cruation  driving  noises  very  considerably,  in  this  case  by 
A 

a factor  of  10  , to  obtain  good  performance. 

Determination  of  Vehicle  Orbit 
^ 

In  the  truth  model  formulation,  no  direct  measurements  of  the  vehicle 

82 


83 


, I 1 1 n nn  I n II I : II  nnni  III  I III  I ,,, ,, , , , ,, 

, , , ...  “ <<"!'iiiiiiii:i,iiiiiiiiiiir/iiiiiii,iiiiiiiiiiniinif 

• M i M 1 1 1 1 f 1 1 1 1 i 1 1 II 1 1 1 f ) M i 1 1 i 1 1 1 i 1 1 M I (I  ’ I If  m I M 1 1 1 M M M M ir  t r ' I ' I M M i I : U I M I ii  I fi  1 1 ) M I f i I 


HD.DD 


Gn.DD 

TIME 


iFo.DD  iBn.nn 


Fig.  14  Filter  Error  Standard  Deviation-Tuned 


inertial  position  and  velocity  are  included.  In  fact  such  measurements 
could  not  be  made  directly  from  the  vehicle  without  usinp  an  inertial 
navipation  system.  It  is  feasible  that  measurements  could  be  taken  by 
a ground  station  and  transmitted  to  the  aircraft  during  the  pass. 

However,  the  system  was  tested  assuming  only  measurements  of  tracker 
acceleration,  trackt^r  angular  velocity,  misalignment  angles,  and  range. 

The  inclusion  of  further  measurements  might  be  a logical  extension  to 
this  study.  It  is  interesting  to  observe  the  behaviour  of  the  filter 
with  the  present  formulation.  Figs.  1C  and  11  illustrate  the  error  stan- 
dard deviation  for  inertial  position  Xj,  for  the  filter  and  system  respec- 
tively. Figs.  16  and  17  shoti?  a very  similar  trend  in  Figs.  18  and 

19  illustrate  the  error  in  inertial  velocity  state  Xi,  for  filter  and 
system  ; espectively.  The  typical  error  standard  deviation  in  a position 
component  is  about  AO  km  and  that  in  a velocity  component  is  about  190 
m/sec.  The  following  observations  can  be  made; 

a.  The  transient  performance  is  extremely  slow. 

b.  Initially  (see  Figs.  18  and  19)  the  measurements  have  no  effect 
on  inertial  velocity  errors. 

c.  As  the  inertial  position  estimate  improves,  the  measurements 
begin  to  give  an  improvement  in  the  inertial  velocity  esti- 
mates. The  time  lag  is  approximately  AO  seconds. 

d.  The  improvement  in  the  inertial  velocity  estimate  during 
the  complete  200  second  run  is  relatively  small.  V’ith  an 
initial  condition  of  200  m/sec  error  standard  deviation,  the 
final  error  standard  deviation  is  193  m/sec. 

e.  Towards  the  end  of  the  200  siecond  run,  the  position  estimate 
errors  begin  to  show  a divergent  characteristic.  This  could 
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be  due  to  tlie  fnct  thut  as  ranp^e  increases  and  the  satellite 
goes  out  of  view,  tlie  neasurenents  begin  to  have  less  effect. 

The  main  conclusion  to  be  drauTi  from  these  observations  is  that 
the  orbital  estimate  is  not  significantly  improved  bv  th.e  measurement 
information.  Tiie  latter  is  coupled  into  the  orbital  state  equations  via 
the  relative  acceleration  of  tlie  vehllce  tc  the  aircraft,  expressed  in 
tracker  coordinates.  This  in  turn  is  a function  of  the  aircraft  inertial 
acceleration,  the  vehicle  inertial  acceleration  which  is  dependent  on  the 
vehicle  inertial  position,  and  the  coordinate  transformation  matrix  from 
tracker  to  inertial  coordinates,  v;hich  is  assumed  kno™.  The  coupling 
if  complex;  if  a measurement  of  improves  the  estimate  of  tliat  state, 

then  this  improvement  is  coupled  through  Aj.^  into  the  vehicle  inertial 
position  estimate.  Recalling  the  filter  model  state  equation  for  w^Sy’ 


^LS, 


~^rz  _ ^ 


R 


‘^Sy  ‘^LSz 


(6-1) 


It  v;ould  seem  equally  important,  since  Aj.^  is  a function  of  vehicle  iner- 
tial position,  for  the  estimiate  of  the  vehicle  inertial  position  to  be 
good  in  order  to  maintain  a good  estimate  of  wj  This  loop  in  the 

coupling  v:ill  be  discussed  later. 


Tracking  Accuracy 

The  accuracy  in  the  tracking  is  expressed  by  the  standard  deviation 
of  the  errors  in  the  misalignment  angles  6c  and  6p.  These  errors  are  in 
turn  affected  by  the  errors  in  line  of  sight  angular  velocities,  range, 
range  rate,  and,  as  already  discussed,  the  vehicle  state.  Figs.  20  and  21 
shov7  the  standard  deviation  of  the  error  in  the  misalignment  angle  6p. 

The  transient  is  short  and  a mean  steady  state  standard  deviation  of 
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0.15  X 10  rad  is  achieved.  This  translates  to  about  9 ra  off  target 
center  for  maximum  range  of  about  600  km,  and  about  2 m for  minimuia 
range  of  about  100  km. 


Effect  of  Orbital  Estimate  To  determine  how  the  orbital  estimate 

improves  or  degrades  the  tracking,  consider  equation  (6-1).  The 

term  effectively  helps  to  provide  a prediction  of  the  range  in 

between  measurements.  If  Aj.^  is  incorrect  bv  say  1%  then  the  change 

in  between  measurements  will  be  incorrect  by  a similar  relative 

magnitude.  VHien  the  measurement  is  taken  therefore, the  antenna  will  be 

misaligned  and  some  portion  of  this  misalignment  will  have  been  caused 

by  the  original  error  in  Aj-  . The  measurement  information  in  turn 

couples  back  through  A to  improve  the  estimate  of  vehicle  inertial 

Z 

position.  The  loop  is  of  course  continuous  and  the  above  simnlified 
analysis  was  made  to  illustrate  the  follov;ing  point.  Given  a worst  case 
situation,  the  typical  error  standard  deviations  in  inertial  position 
of  AO  V-1  as  in  fact  produces  an  error  in  Ar^  of  only  17'.  Propagation 
of  this  error  over  2 seconds  results  in  the  misalignment  angle  of  about 
2 X 10”^  rad.  This  is  small  compared  to  the  error  standard  deviations 
shown  by  Figs.  20  and  21.  In  addition,  it  represents  the  worst  case 
effect.  Supposing  however  that  a tracking  accuracy  equivalent  to  a 
misalignment  cingle  error  standard  deviation  of  10“^  rad  were  required. 

The  errors  in  inertial  position  would  then  be  significant.  There  is  a 
specific  conclusion  however  which  is  quite  surprising.  To  achieve  an 
error  standard  deviation  of  10“^  rad  in  misalignment,  an  error  standard 
deviation  of  AO  km  in  Inertial  position  can  be  tolerated,  provided  the 
measurement  update  interval  is  small,  i.e.  of  the  order  2 seconds  or  less, 
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ilodlf Ications  to  T n.i^t li  Model 

Objective.  The  purpose  in  chanp^tnr,  tliC  trutli  model  vas  to  demon- 
h trate  that  the  filter  would  perform  over  a reasonable  ranpe  of  measuring 
device  precision.  The  tracking  achieved  v;ith  the  baseline  simulation 
parameters  resulted  in  an  error  standard  deviation  in  dc  and  dn  of 
0.15  X 10"“^  rad.  This  is  equivalent  to  an  error  standard  deviation  of 
9 m off  target  at  maximum  range  and  2 m at  minimum  range.  Choosing 
arbitrarily  a requirement  for  1 m at  maximum  range  implies  tiiat  the  5e 
and  on  error  standard  deviations  should  be  less  than  1*7  x 10”^  rad  at 
maximum  range.  The  objective  therefore  was  to  modify  the  tri.  th  model 
to  find  the  necessary  measuring  instrument  nuality  to  achieve  this  re- 
quirement. In  so  doing,  the  filter  would  be  evaluated  over  a differing 
range  oc  measurement  parameters. 

Approach  The  approach  taken  was  to  investigate  the  effect  of 


( 


improving  the  measurements  of  line  of  sight  angular  velocity,  tracker 
misalignment,  tracker  acceleration,  and  range.  The  tracker  acceleration 
and  range  measurements  were  first  investigated.  Adjusting  the  truth 
model  measurement  parameters  to  make  these  measurements  perfect  had  no 
discernable  effect  on  the  tracking  accuracy.  In  fact,  the  m.easurements 
could  be  degraded  by  a factor  of  2 in  the  case  of  range  and  by  a factor 
of  approximately  5 for  acceleration,  before  tracking  accuracy  became 
affected.  The  critical  measurements  were  therefore  those  of  line  of 
sight  angular  velocity  and  misalignment  angles. 

Adjustment  of  Angular  Velocity  and  Misalienment  /angles  The  process 
of  adjusting  the  truth  model  measurement  parameters  was  slow  and  tedious 
since  each  adjustment  required  a retuning  of  tlie  filter.  The  gyro  drift 
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term  in  tl.e  coasurenents  of  anp.ulnr  velocities  was  found  to  be  the  largest 
single  source  of  measurement  error.  This  terra  was  adjusted  progressively 
from  10“^  rad/sec  to  10“^  rad/sec.  After  each  adjustment  the  filter  was 
retuned.  The  resulting  error  standard  deviation  in  the  estimate  of  6c 
is  sho\jn  by  Figs.  22  and  23.  (N'ote  that  6c  and  6n  have  Identical  error 
characteristics.)  The  mean  steady  state  error  standard  deviation* was 
5 X 10”^  rad,  which  is  equivalent  to  an  error  standard  deviation  of  3 ra 
off  target  center  at  maximum  range.  A drift  of  10“^  rad/sec  is  in  fact 
close  to  the  region  of  current  'state  of  the  art'  gyros.  A further  im- 
provement in  gyro  drift  to  0?5  x 10“'^  rad/sec  did  not  significantly  im- 
prove the  estimates  of  6c  and  6n.  It  was  therefore  concluded  at  this 
point  that  a further  improvement  in  the  estimates  of  6c  and  6n  could  only 
be  obtained  by  improving  the  measurements  of  those  quantities. 

Figs.  24  and  25  again  show  the  error  standard  deviations  for  the 
misalignment  angles  6e  and  6n.  These  performance  curves  were  obtained 
by  improving  the  angle  track  scintillation  noise  from  a standard  devia- 
tion of  10“^  rad  to  10“^  rad  and  totally  removing  the  angle  track  bias. 

The  resultant  error  standard  deviations  for  6c  is  2 x 10"^  rad  which  is 
equivalent  to  an  error  standard  deviation  of  1*2  m off  target  center  at 
maximum  range  and  0 *2  m off  target  center  at  minimum  range. 

Finally,  Figs.  26  and  27  show  the  overall  improvement  to  the  error 
standard  deviation  for  the  estimate  of  vehicle  inertial  position  Xj.  The 
figure  has  been  improved  from  about  40  kon  to  about  20  km.  Fig.  27  shows 
the  true  improvement  to  be  nearer  10  km.  This  implies  that  the  filter 
is  overestimating  the  error  by  a factor  of  2 and  requires  further  tuning. 
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Sumnary  of  Effect  of  Truth  Model  ■ d 1 f 1 c a t ion s 

To  achieve  Che  requirement  of  approximately  1*7  x 10"^  rad  for  the 
error  .'jtandard  deviations  in  the  estimates  of  6c  and  5n,  it  was  found 
necessary  to  (1)  reduce  the  gyro  drift  standard  deviations  from  10“® 
rad/sec  to  10“^  rad/sec,  (2)  remove  tie  angle  track  bias  errors,  and 
(3)  reduce  the  angle  track  scintillation  noise  standard  deviation  from 
10”^  rad  to  10“^  rad.  Fig.  28  shows  the  family  of  error  curves  des- 
cribing the  adjustments  made  and  the  resulting  performance.  Each  point 
on  the  curve  represents  some  five  computer  runs  for  the  system. 

Clearly,  these  results  indicate  some  stability  in  the  filter  formu- 
lation over  a small  range  of  measurement  performance.  It  is  emphasized 
however  that  only  a snail  group  of  measurement  parameters  were  tested  and 
the  results  are  by  no  means  general. 

Various  recommendations  for  modifications  to  the  truth  model  formu- 
lation will  be  made  in  the  next  section. 
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VII.  rj:co'i>:i:;)dations  ^\i:d  cc;;clusio:is 


Addition  of  Further  Ileasurements 


Coordinate  Frames  Tlierc  are  four  basic  coordinate  frames  used  in 
t'ne  problem,  the  earth  centered  inertial  and  earth  centered  rotating 
coordinate  frames  which  are  related  by  the  earth  rotation  rate,  and  the 
line  of  sight  and  tracker  coordinate  frames  which  are  related  by  the 
misalignment  angles  6e  and  6n.  The  relationship  between  the  tracker 
coordinate  frame  and  the  inertial  earth  ce'>teied  coordl-'.ate  frame  was 
established  by  assuming  that  the  tracker  base  could  be  maintained 
inertially  stable,  and  that  the  two  angles  6 and  0 (see  Fig.  1,  section 
ll)  were  available  (i.e.  through  perfect  measurements). 

It  is  somewhat  unrealistic  to  assume  that  perfect  measurements  of 
e and  0 are  available.  In  practice  some  type  of  resolver  or  integrating 
device  would  be  used  and  stochastic  modeling  techniques  might  be  necessary 
to  model  the  device  outputs  accurately.  Thus  the  inclusion  of  a realistic 
measurement  model  for  6 and  for  0 would  be  desireable. 

Orbit  Determination  The  typical  aircraft  engaged  in  the  long  range 
satellite  trackin'-  role  would  proba’ ly  be  equipped  w'ith  an  inertial  navi- 
gation system  (J.'^S)  to  provide  aircraft  Inertial  position  information. 

Novr  let  be  the  range  vector  from  aircraft  to  satellite  expressed  in 
inertial  earth  centered  coordinates.  Then  if  the  aircraft  inertial  posi- 


tion vector  is  and  the  satellite  inertial  position  vector  is 


— 


Xl 

X2 

X3 
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T 

For  perfect  trackingj  R is  tlic  vector 

» 

T j j 

of  , C whicli  is  a function  of  6 and  and  R , provides  an  accurate 
mea.suremen t of  tlie  satellite  inertial  position.  Thus  tl;e  measurenients 
of  ‘j  and  0 coupled  with  the  Ih'S  measurement  of  1^  can  be  used  to  provide 
a ineasurenent  of  R^.  Improvement  of  the  estimate  of  satellite  inertial 
position  would  lead  to  improvement  in  the  estimate  of  satellite  inertial 
velocity  wdiich  in  turn  would  lead  to  an  improvement  in  the  accuracy  in 
orbit  determination. 

how  t'ne  sensitivity  of  tracking  accuracy  to  the  accuracy  of  the 
orbital  estimate  was  not  totally  established.  It  was  clear  that  the 
critical  measurements  were  those  of  angular  velocity  and  angular  devia- 
tions. liov.'cver,  using  ’state  of  tie  art'  measuring  devices,  it  may 
still  be  possible  to  achieve  improved  tracking  performance  with  a better 
orbital  estimate.  The  inclusion  of  IhS  position  information  is  there- 
fore considered  desireable. 

Alternate  Metho ds  of  Model ing 

Extending  the  above  discussion  further,  if  IhS  velocity  information 
were  also  available  then  an  alternate  m.odel  formulation  is  possible.  Th 
state  of  the  satellite  vehicle  is  completely  described  bv  inertial 
position  and  velocity  vectors.  Simile  rly,  the  aircraft  state  is  com- 
pletely described  by  inertial  position  and  velocity  vectors.  In  fact, 
the  relative  position  and  velocity  vectors  from  aircraft  to  .satellite 
would  also  be  completely  described  by  these  four  vectors.  The  tracking 
problem  is  in  essence  a problem  of  estimating  the  relative  position  and 
velocity  vectors,  so  that  one  method  of  modeling  the  svstem  w’ould  be  to 
use  inertial  states  for  the  aircraft  and  satellite.  This  would  result 


R 

0 

n 


Thus  accurate  knowledge 
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in  a 12  state  model  which  is  of  the  same  dimension  as  the  current  filter 
model  and  additional  states  could  be  included  if  necessary  to  account 
for  measurement  parameters. 

Considering  the  geometry  of  the  tracking  problem,  the  inertial 
formulation  might  be  better  conditioned  numerically  when  target  and 
tracker  are  widely  separated  in  the  inertial  coordinate  frame,  li,  ..he 
target  and  tracker  are  in  a i lose  configuration,  in  which  the  magnitude 
of  the  range  vector  is  small  compared  ot  the  magnitudes  of  the  two 
inertial  position  vectors,  then  modeling  the  problem  in  the  line  of 
sight  coordinate  frame  would  probably  be  better  conditioned  numerically. 
IThen  tracking  a low  orbit  satellite,  both  situations  exist.  Initially, 
as  the  satellite  appears  over  the  horizon,  the  two  vehicles  are  widely 
separated  inertially.  As  the  satellite  passes  near  to  the  aircraft 
however,  the  range  vector  can  bccom.e  small  in  magnitude.  The  incorpora- 
tion of  aircraft  inertial  position  measurements  into  the  present  formu- 
lation is  one  method  of  meeting  both  situations. 

Method  of  Analysis 

The  filter  was  tested  using  the  covariance  analysis  method.  The 
performance  results  are  therefore  valid  only  if  the  various  approxima- 
tions and  assumptions  described  in  section  IV  are  also  valid.  The 
Monte-Carlo  analysis  method  does  not  make  such  approximations  and 
assumptions.  The  method  involves  making  multiple  runs  using  the  non- 
linear state  equations  and  artificial!  ■.  generated  white  Gaussian  noises. 
Thus,  provided  a large  number  of  runs  are  made,  a general  run  performance 
trend  can  be  obtained.  The  usual  problem  with  the  Monte-Carlo  method  Is 
the  practical  limit  on  computational  time.  If  the  method  "'s  compared  to 
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the  covariance  analysis  method  however,  this  is  not  such  a severe 
problem.  The  latter  generally  requires  a verv'  large  and  complex  com- 
puter program  and  multiple  runs  arc  often  necessary  in  any  case,  to 
ensure  satisfactory  performance  of  the  program.  It  should  be  recalled 
also  that  the  covariance  an.alysis  is  tlie  first  step  analysis  for  a 
filtering  problem.  It  is  therefore  recommended  that  further  analysis 
of  the  problem  should  bo  carried  out  with  the  Monte  Carlo  method. 


Summary  of  Recomm e ndations 

a.  The  addition  of  realistic  measurements  for  the  angles  6 and  0 
in  the  coordinate  transformation  matrix  should  be  investigated. 

b.  Measurements  of  aircraft  inertial  position  and  velocity  should 
be  investigated  and  incorporated  if  performance  benefits  so  dictate. 

c.  The  possibility  of  system  modeling  entirely  using  inertial 
coordinates  should  be  investigated. 

d.  With  the  present  formulation,  further  work  could  now  be  carried 
out  using  the  Monte-Carlo  analysis  technique.  If  the  filter  is  signi- 
ficantly redesigned,  then  the  covariance  analysis  method  should  again 

be  used  as  the  first  step  analysis. 


Conclusions 

The  work  carried  out  in  this  study  falls  into  three  categories; 

a.  Development  of  the  truth  model  and  filter  model  state  and 
measurement  equations. 

b.  Description  of  the  Extended  Kalman  Filter  and  covariance 
analysis  method  equations. 

c.  Testing  of  the  filter. 


Part  c.  represents  the  majoritv  of  the  work.  Where  possible, 
existing  computer  programs  were  used.  This  was  done  to  save  program 
development  time  vdiich  essentially  detracts  from  the  real  thrust  of 
the  study,  however,  in  retrospect,  it  might  have  been  better  to  develop 
nc\;  programs  since  the  redevelopment  of  existing  programs  vjas  a verv 
time  consuming  task. 

The  most  difficult  part  of  the  actual  testing  v?as  the  filter 
tuning.  This  basically  involved  changing  various  parameters  in  the 
filter  model  to  maximize  filter  performance.  The  task  is  similar  to 
an  optimization  problem  where  several  parameters  are  simultaneously 
adjusted  for  optimum  filter  performance.  Since  each  computer  run 
required  considerable  computational  time  and  storage,  the  optimization 
process  v;as  slow  and  tine  consuming. 

As  a V7hole,  however,  the  study  was  an  informative  experience.  There 
is  much  work  still  to  be  done  in  the  area  of  aircraft  to  satellite  track- 
ing, but  this  study  has  certainly  indicated  some  of  tlie  areas  ’■.■’here  pro- 
blems can  be  expected,  and  some  of  the  metliods  through  which  they  can  be 
solved. 
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Appendix  A 

Derivation  of  Cravitationnl  Forcc-r;  Due  to  Earth  (Refs.  8,  9,  10,  11) 

Fig.  29  below  sliows  the  inertial  earth  centered  coordinate  fra'.ne 
(I  - frar.e)  and  the  rotating  earth  centered  coordinate  frame  (r  - frame). 
The  two  frames  align  when  0=0. 


Vernal  " 

Equinox 

Direction 


Fig.  29  Inertial  and  Rotating  Coordinate  Frames 

Defining  the  Earth's  gravitational  potential  as  U which  is  a func- 
tion of  position  X^.,  Y^.,  in  the  rotating  frame  i.e.  U = D(Xj.,Yj.,Zj.) , 
then  at  any  point  in  space,  the  three  components  of  gravitational  force 

expressed  in  the  rotating  coordinate  frame  can  be  defined  as  Ap  » ^ » 

X— 


and 


Ag^  such  that: 
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«x 


9 U 


9 U 
9Y 


8Z. 


9 U 
3Z- 


If  u IS  deflnad  thsreforc,  the  gravitational  forces  In  the  rotating 
frame  can  be  calculated.  The  forces  are  recuired  however  In  the  Iner 
rial  coordinate  frame  so  a coordinate  transformation  from  rotating  to 
Inertial  coordinates  must  be  defined.  Let  c'  be  the  coordinate  trans- 
formation matrix  from  rotating  to  non-rotating  (Inertial)  coordinates, 
then ; 


cos  (0)  - sin  (0)  0 1 


sin  (e) 


cos  (0)  0 


1 J 


where: 


0 = 0go  + V.’E  t 

0go=  Local  Greem^ich  hour  angle  at  t - 0 

^ = Earth  rotation  rate 

t = time 


and  if  the  force  due  to  gravity  in  the  Inertial  coordinate  system  Is 
the  vector: 


114 


CA/KF77/.-3 


f 

K 


A 


r A n 


L 


then: 


r A - 

1 

> 

*.-0 

X 

A 

^2 

= 4 

A 

gyr 

A 

^3 

L -1 

Model  U(Xj.,  Yj. 

Z^) 

The  problem  under  consideration  examines  the  tracking  problem  for 
a near  earth  satellite.  In  order  to  express  the  gravitational  forces 
due  to  the  earth  for  a low  orbit  satellite  accurately,  the  following 
gravitational  potential  model  was  chosen: 


m 


6 

1 + 1 
k = 2 


K. 

1 

m = 0 


(sin<i>) 


^k.m 


+ sinCmAj.) 

where  the  terras  in  equation  (a-1)  are  defined  Is  follows: 
kg  is  the  gravitational  constant  for  the  earth 
m is  the  mass  of  the  earth 


(a-1) 


r is  the  radial  distance  of  the  body  from  the  earth 
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P (f>l)  T 

il,  are  Lcccndre  functions,  that  is  the  functions; 

W ° (1  - X ( p 

d x'^  1 

and  is  the  Legendre  polynomial  c'itli  arguiaont  x. 

*<ote  tnat  in  equation  (3),  the  argument  of  tlie  Legendre 
polynomials  is  sin  0. 

is  the  longitude  of  the  satellite  witli  respect  to  the 
Greenwich  meridian 

0 is  the  geocentric  declination  angle  for  the  satellite 

^k,m  harmonic  coefficients  for  the  gravitational 

potential  such  that; 

S.o  ~ - -^k  and  = 0 

and  the  Jj^(o)  coefficients  are  termed  'zonal  harmonic’ 

'"k,m  ^k,ra  are  termed  'tesseral  harmonic'  if  m k,  m > 0 

and  'sectorial  harmonic'  if  m = k 

The  significance  of  the  terms  zonal,  tesseral,  and  sectorial  is 
illustrated  by  Fig.  30(Ref.  9) 
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Zonal 

= .1.,  m = 0) 

Side  view  gr"!  I’l  _ ~J 

V — 'Xcjj'  >agay 


Tcsnoral 
(0  ' m ^ k ) 


^ ^ W 


Top  view 


O Qi  O O '0  Ct-  0 €>  S 


2,0  3,0  4,0  5,0 


"r-i  (9> 

<05 


3,1  3,2  4,1  4,2  4,3 


Sectorial 
(n  = k) 


2,2  3,3  4,4 


Fig.  30  Gravity  Hanronlcs 


Equation  (3)  could  be  extended  to  include  higher  harmonics  than 
6,6,  This  would  largely  depend  on  the  type  of  orbit  and  the  accuracy 
required.  For  the  purposes  of  this  study,  the  harmonics  up  to  and  in- 
cluding 6,6  are  defined  to  represent  the  true  gravitational  field.  Th 
any  filter  model  which  might  use  a lower  order  model  will  be  compared 
against  this  particular  truth  model,  and  the  inclusion  of  higher  terms 
in  the  truth  model  would  not  significantly  improve  this  comparison. 


Calculation  of  the  Second  Partial  Derivatives  of  U (Ref.  16) 


In  order  to  linearize  the  state  equations  for  use  with  the  Extended 
Ealman  Filter,  it  will  be  necessary  to  find  the  second  partial  derivatives 
of  the  gravitational  potential  U with  respect  to  the  satellite  inertial 
position  (X  , X2  , X^)  measured  along  the  X,  Y and  Z axes  respectively 
of  the  inertial  frame  (see  Fig.  1).  The  analytic  calculations  of  the 
first  partials  only  are  long  and  complex  and  result  in  several  hundred 
terms.  An  analytic  calculation  of  the  second  partials  would  be  complex, 
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prone  to  error  and  too  time  eonsuminp;  computationally.  In  Ref.  16,  it 
was  shown  that  for  this  type  of  orbit,  a one  sided  differencing  method 
provided  an  accurate  value  for  tlie  second  partials  providing  tlie 
differencing  step  size  Is  kept  small.  A step  size  of  1 meter  was 
chosen  since  any  further  reduction  did  not  change  the  numerical  result 
while  at  the  same  time,  a calculation  using  1 meter  did  not  introduce 
round-off  errors.  Calculation  of  Ch.ese  second  partials  is  carried  out 
in  the  rotating  coordinate  frame  to  give  the  matrix  of  second  partial 
derivatives : 


U 


2 


r 


32  U 
'•X^  ^Yr 


32  U 

3 Zj2 


(a-2) 


where  the  notation  Indicates  the  matrix  is  ^d.th  respect  to  the  rotating 

I 

frame.  Defining  U as  the  matrix  of  second  partial  derivatives  taken 

I 

with  respect  to  the  inertial  non-rotating  earth  centered  coordinate 
frame  (I  - frame)  then: 


9^  U 32  u 

3 Xj2 


(a-3) 


32  U 
9X32 


118 


GA/li;/7A-3 


Appendix  B 

Linearization  of  Tru tj i_J ^ del  State  and  Mea s u r c n c n t Fgii a t i on s 
Definitions : 

Xj,  Xj , Inertial  satellite  position  vector 

X^,  X^,  Xg  Inertial  satellite  velocity  vector 

^s’  ^s’  ^s  Position  vector  of  sun  in  eartli  centered  inertial 
coordinates 

y„i  z„  Position  vector  of  moon  in  earth  centered  inertial 
IQ  in  lu 

coordinates 

r^  Distance  from  earth  center  to  satellite 

rg  Distance  from  earth  center  to  sun 

r^jj  Distance  from  earth  center  to  moon 

p Atmospheric  density  at  altitude  h 

Pg  Sea  level  atmospheric  density 

S Altitude  atmospheric  density  decay  rate 

Vg  Magnitude  of  satellite  velocity  relative  to 

rotating  atmosphere 

r-yg  Distance  from  satellite  to  sun 

r^jQ  Distance  from  satellite  to  moon 
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WE 


Earth  rotation  rate 


Matrix  of  second  partials  of  j^ravity  gradient  with 
respect  to  satellite  position  in  earth  centered 
inertial  coordinates 


u (i,  j)  Element  in  row  and  column  of  U2^ 


th 


U,  Matrix  of  second  partials  of  gravity  gradient  with 

2t 

respect  to  satellite  position  in  tracker  coordinates 

(U2t  = ^2i 

u (i,  j)  Element  in  i*-^  row  and  column  of 
Pq  Sun's  gravitational  constant 

pj  Moon's  gravitational  constant 

System  F - Matrix 

Given  the  non-linear  state  equation: 


x(t)  = fs(x(t),  t)  + Gg(t)  Wg(t) 


F (t)  = 

® 9x 


iin(t) 


where  nominal  reference  state  trajectory. 

Using  the  non-linear  state  equation  defined  in  the  summary  to 
section  II,  the  matrix  Fg(t)  is: 
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Fj (8  X 8) 


0(8  X 53) 


82(6  X 8)  83(6  X 6)  ' F^(6  X 11)  , F (6  x 36) 


0(47  X 14) 


F, (11  X 11) 

b 


0(36  X 11) 


0(47  X 36) 


which  is  evaluated  along  x^(t) . The  figures  in  brackets  indicate  the 
dimensions  of  the  various  sub-matrices. 


0(3  X 3) 


1(3  X 3) 


'8  ^9  ^10  ^11  ^12  ® 


0(3  X 2) 


f,,  f., 

i 3 i I4 


^15  ^16  ^17  ^18  ^19  ^ '•  ^20  ^21 


0(2  X 8) 


where; 


f = u(l,  1)  + ( ^'7  S p Xj  (X4  + m X,) 


0.5  X7  m p (X5  - hi-  x,)(X4  + w.  X2) 


Va 


7-VS^ 


^vs^ 


r 3 


r,  ,5 

Viu 
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u(l,  2)  + 0.5  X7Va  e p X2(Xi,  + ET.  X2) 


0.5  X7  v.t:  p (x^  + ut:;  X2)^  1 ( 

( - 0.5  X7  0 w-  Va 


+ - 


f = u(l,3)  + ( ^7  ® P 


0.5  X7  p XjCX^  + I-.T.  Xg) 
Va 


( - X3)  1 

. + 

2)  X 1 ) (zj[^ 

- X3) 

1 r ^ J 

^ ‘■vs  i 

r ^ 
'•vm 

, 

-0.5  X7  p 


(X^  + W.  X2>2 


+ Va 


= "0-5  X?  P (X4  + WE  X2XX5  - W’E  X;) 


-0.5  p Va  (X^  + X2) 


-4.5  X 10"’'  fs 
rs 


GME\iHU-3 


f,  “ -A.5  X 10"^  £^- 

21  rs 


8i  §2  83  1 


54  % 


where ; 


0(3  X 

3) 

0(6  X 5) 

1 

80  8g 

1 

-u 

(3,  1) 

6c  u ( 1 , 1) 

R 

R 

_ -u 

(3,  2) 

6c  u (1»  2) 

R 

R 

= “U 

(3,  3)  _ 

6c  u (1,  3) 

R 

R 

-u 

(2,  1) 

6n  u (Ij  1) 

c 

R 

R 

-u 

(2,  2) 

6n  u (1,  2) 

R 

R 

-u 

(2,  3) 

6n  u (1,  3) 

gy  “ u (1,  1)  + 6n  u (2,  1)  - 6e  u (3,  1) 

gg  - u (1,  2)  + 6n  u (2,  2)  - 6c  u (3,  2) 

gg  = u (1,  3)  + 6n  u (2,  3)  ■■  6c  u (3,  3) 
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System  Qj-  - mntrix  and  - matrix 


If  Q|  is  the  variance  of  the  wiiite  noise  Wj  drivinj’^  the  state 
e(;i  \tion  for  X(^  , 0^  is  the  variance  for  V’2  and  0^  is  the  variance  for 
then: 


0 0 


0 (^2  0 


0(3  X 11) 


0 0 Q, 


and  G is  given  by: 


0(11  X 3) 


1(11  X 11) 


0(3  X 3)  I 


1(3  X 3)  1 


C(1A  X 11) 


0(55  X 3) 


\ 2 6 1 uj 


V2b7 


V2B3  °- 


N. 


V^ii  °ii 


0(36  X 11) 
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System  H - matrix  and  R^  - matrix 


Given  the  non-linear  measurement  eouation: 


Zs(ti)  = l}s(x(ti),  ti)  + VgCti) 


H. 


^]js 

3x 


2in(t) 


wnere  x^(t)  is  the  nominal  reference  state  trajectory. 

Using  the  non-linear  measurement  equations  defined  in  the  summary 
to  section  II,  and  defining  th.e  components  of  ^s(tj^)  as: 


IJh)  = 


"m 


'M 


% 

and  assuming  the  constants  K K and  K„  are  all  uni  tv,  then  lL(t)  is 

X 2 ^ ° 

given  by: 


iigCt)  = 


Ho 

Si 

(5  X 16) 


(5  X 10) 


H 

S3 

(5  X 11) 
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and  Rj.  is  given  by: 


and  R is  Che  variance  of 

Si  2 


Rs  is  the  variance  of  Vn 
2 ^ 


Rg^  is  Che  variance  of  V7 


Re  is  Che  variance  of  Vq 
4 ° 


Rg^  is  the  variance  of  Vg 


Note  also  that  the  above  llg  matrix  is  evaluated  along  Xj^(t) 
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Appendix  C 


I^incnrizat  i on  of  Filter  Model  Sinte  and  ' 1 easure.T ent  Enuati 


ons 


Definitions : 


Xj,  Inertial  satellite  nosition  vector 


Inertial  satellite  velocitv  vector 


Ty  Distance  froia  earth  center  to  satellite 


Matrix  of  2nd  partials  of  gravity  gradient 
with  respect  to  satellite  position  in  earth 
centered  inertial  coordinates 


u(i,  j)  Element  in  i^'’  row  and  column  of  U' 


U„ 


Matrix  of  2nd  partials  of  gravity  gradient 

respect  to  satellite  position  in  tracker 
coordinates 


u(i,  j)  Element  in  ith  row  and  column  of  U, 


© 


Earth's  gravitational  constant 


Filter  Model  F - matrix 

Using  the  non-li.near  state  equations  defined  in  the  summary  to 
section  V,  the  filter  model  F - matrix  denoted  F„  is  given  by: 


- 


Fl 

(6  X 6) 


0 

(6  X 6) 


F2 

(6  X 6) 


Fa 

(6  X 6) 
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whxch  is  evaluated  alone  x_(c)  Tlie  f-tenrn.'  ^r.  i t . , 

h n t if’, liras  in  brackets  indicate  the 

dimensions  of  the  suh-iaatr ices . 


O X 3)  (3  X 3) 


U; 


(3  X 3) 


0 

(3  X 


where : 


^ , 3,3X1' 


r ^ 


3m©XiX2 


3Pm  X,X 


1''3 


rv' 


3,0  XnX] 
>.  5 


3,0  X2X3 


3^'0  y>3Xi  3,q  X3X0 


ryS 


r 5 


1^©  + 
- 3 


3’^©  ^3^ 


-U  (3,  1) 
R 


•u  (3.  2) 
R 


-G  (3,  3) 


n (2,  1) 

R 


5 (2,  2) 

R 


5 (2.  3) 
R 


0(3  X 3) 


0 

(6  X 3) 


u(l,  1)  nci,  2)  G(l,  3) 
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niter  Model  0 and  Matrices 
' ^ 

Let  Qp  be  defined  as  the  covariance  rratrix  E { u(t)  w’^(t) 
where ; 

to  ( t ) ■= 

Wi  to  are  independent  Gaussian  white  noise  processes  so  that 
Qp  is  a diagonal  6x6  matrix  and: 
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Filter  Kodel  Mp  and  Rp  Matrices 


Let  Rp  be  tiie  covariance  matrix  l | v(t)  vT((.) 

V. 


where ; 


v(t^ 


’'8 

i Vg 


The  elements  of  the  vector  are  independent  Gaussian  white  noise 
processes  so  that  is  a diagonal  5x5  matrix  and: 


2-5  X 10-12 


2-5  X 10-12 


6 X 10~12 


6 X 10“ 12 


450 


where  rl.e  figures  are  derived  using  rhe  truth  model  data  set  In  Appendix 
0.  Hp  is  the  5x5  identity  matrix. 
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Appendix  D 


Truth  Model  Si::iiilat:lo n P n rn r. e t e r s 

The  following  simulation  parameters  are  used  initially  in  the 
truth  model  measurerner.t  equations. 


Rate  Gyro  Measurements 

The  figures  are  based  on  Ref.  15,  page  302  representing  a typical 


aircraft  gyro. 

Quantity 

Gyro  drift 
Gyro  scale  factors 

Gvro  mass  unbalance 
coefficients 

Gyro  misalignment 
coefficients 

Additive  white  noise 


Steady  State 
Standard  Deviation 

1 X 10  ^ rad/sec 
5 X 10-'^ 

3 X 10“^  rad-sec/m 

1 X 10-** 

1 X 10~^  rad/sec 


Process 

Correlation  Time 

1 hr 
00 

CD 

00 

0 


The  gyro  drift  correlation  time  is  typically  much  larger  then  1 hour, 
ine  time  was  reduced  to  1 hour  to  model  a worst  case  drift.  The  mis- 
alignment coefficients  have  been  approximately  estimated  and  the  white 
noise  is  based  on  uncertainty  in  the  gyro  drift. 


Accelerometer  Measurements 

-he  figures  art  based  on  Ref.  15,  page  291,  representing  a typical 
acclerometer. 
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Angle  track 
scintillations 


1 X 10"^  rad 


Angle  measurement 
scale  factors 

Angle  track  bias 

Additive  white  noise 


CA/KI':/7A-3 


Ron^;e  Measurement 

Again,  the  r.-mge  measurement  parameters  V7ill  vary  depending  on  the 
device  used.  The  following  figures  are  therefore  approximately  esti- 
mated as  representative  of  a typical  device. 


Quantity 

Range  scintillation 
Range  bias 
Additive  white  noise 


oteady  State 
Standard  D eviation 

20  m 

5 m 

5 m 


Process 

Correlation  Time 
10  sec 
00 

0 
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:-nd  cubco';uor.tly  \r-.z  a-,;ardcd  a 
cadcuL'hip  at  tho  dcyal  Air  Aorao  BcdTord- 

Ehirc  and  tlio  .ny.il  Air  I'once  '-r-.n'.::'".!,  LincolnaiiirG . 

;;c  "rntuaio-:  ino.-n  n'rrr.:oll  in  1967  ’..'itA  a Bacn.alor  of  icioncc 
dor;rrjG  in  AGr:.naul,ica.l  A.nrd.nocrin^  •.;ith  an  Aloe  trie aj.  cpccialination 
As  an  Anr'inaor,  he  served  as  lain Aenance  Gfiiccr  for  Aadar  and 
Romanic ations  systens-  at  .V.7  Patrinyton,  Yorh.shire  duriny  the  porio 
1969  to  1971.  Until  I'ay  1973  he  sex-'ved  at  7-AP  Ua'.'.hancer,  Arenshire 
as  the  i’.rjn'.ct  Apacccraft  Aperations  '/ffieer  '..’here  he  vas  in; sponsible 
for  on-orbit  satellite  control  functions  and  prejeeb  v:orh  for  now 
satellite  systera:.  In  hay  1973  he  entered  the  UraJuate  Astronautical 
Anyinecriny  prc.yran  at  tlic  Air  Porcc  Institute  of  Tcchnclo-,',  Uriyht 
Patterson  Air  Pome  3a.se,  tbio,  USA, 


